Полуавтоматическое управление насосом скважины

/*
 Name:		Nasos.ino
 Created:	23.02.2017 19:08:20
 Author:	Ksiw
 Архитектура программы заключается в установлении флага на включение реле различными способами, дабы  в последстви проверить его(флага) статус и тогда переключить реле в соответственное положение.
 Если кнопка ручного включения не зажата, то цикл выполняется примерно 10 раз в секунду.
 Если кнопка зажата, то вначале дается десятая секунды во избежание дребезга, далее, проверка состояния кнопки происходит 20 раз/сек.
  99% всего времени камень отдыхает пребывая в delay()
*/
unsigned long Work = 2UL*60;             /*2 минуты работы*/ // укажи тут время работы в минутах, с приведением типов
//это не просто какая то дичь... Однако! Без приведения умножение вычислялось неверно.			
const unsigned long Sleep = (unsigned long)20*60;       //а тут простоя

unsigned long TimeLeft;                          //осталось секунд до переключения

int tempo = iter;                                    //сразу вывести 
int iter = 10;                                         //пропускать итераций перед следующим выводом в порт

unsigned long timeNextSwich;

int button = PB4;                                    //пин кнопки
unsigned long WorkTime, SleepTime ;       // время в миллисекундах продолжительность включения насоса в минутах

bool handOn = false;                      //флаг ручного включения
bool flag;                                       //флаг статуса реле
int RelayPin = PB7;                         //пин управления реле
unsigned long PreviousMillis = 0;
unsigned long CurrentMillis = millis();


unsigned long fullTimeIteration = 4200000000;          //вычисление времени рестарта программы //(long 4,294,967,295)
//---------------------прототипы
void SwichFlag();
void SwichRelay();
void Button();
unsigned long SecToMillis(unsigned long);
void ResidueTime();
void ResetTimeToWork();

//-------------------------------------в начало программы---------------------------
void(*resetFunc) (void) = 0;

//********************************ПУСК*******************************************
void setup()
{
	Serial.begin(115200);
	flag = false;        //включение реле при загрузке микроконтроллера

	//-----------Инициализация вывода реле
	pinMode(RelayPin, OUTPUT);
	pinMode(button, INPUT);
	digitalWrite(RelayPin, flag);
	Serial.println("");

	WorkTime = SecToMillis(Work);
	SleepTime = SecToMillis(Sleep);
	PreviousMillis = millis();
	

}

void loop() //****************************ЦИКЛ**********************************************
{
	
while(true)
	{
		CurrentMillis = millis();          //текущее время
		ResetTimeToWork();                 //проверка переполнения milis()
		SwichFlag();                       //проверка необходимости переключения
		SwichRelay();                      //переключили реле, если флаг изменился
		ResidueTime();                     //вывод в порт
		Button();                          //обработка кнопки

		tempo++;
		handOn = false;
		delay(100);
	}
}
//-------------------------------------переключение флага----------------------------------------------
void SwichFlag()
{
	
	if(flag && CurrentMillis-PreviousMillis>=SleepTime)
	{
		PreviousMillis = CurrentMillis;
		flag = false;                                //если разница предыдущего замера и текущего времени больше времени сна, но уставим флаг на включение
		Serial.println("Flag On");
	}
		
	else if(!flag && CurrentMillis-PreviousMillis>=WorkTime) //Иначе, если реле включено и пришло время выключаться, переключим флаг в "выключено"
	{
		PreviousMillis = CurrentMillis;
                flag = true;
		Serial.println("Flag OFF");
	}
}
//-------------------------------------работа кнопки-------------------------------------------------------
void Button()
{
	if(digitalRead(button)==HIGH)                              //если кнопка нажата
	{
		do
		{
			if(handOn)
			{
				delay(50);
				continue;
			}
			Serial.println("TURNED ON");
			digitalWrite(RelayPin, LOW);                 //то включаем реле
		                    
			flag = true;
			handOn = true;
			delay(100);                                        //и немного удерживаем
		 
		}while (digitalRead(button)==HIGH);

		CurrentMillis = millis();                 //узнаем и записываем когда это окончилось
		PreviousMillis = CurrentMillis;        //обновляем время последних действий
		delay(20);
	}
}
//-------------------------------------преобразование секунд в миллисекунды---------------------------
unsigned long SecToMillis(unsigned long Temp)
{
	return Temp*1000;
}
//-------------------------------------время до переключения----------------------------------------------
void ResidueTime()
{
	if(CurrentMillis<PreviousMillis && tempo > iter)
	{
		if(flag)
		{
			TimeLeft = timeNextSwich/1000+1;
			Serial.print(" Time to ON: ");
			Serial.print(TimeLeft);
			Serial.print("sec");
			Serial.println("");
		}
		else
		{
			TimeLeft = timeNextSwich/1000+1;
			Serial.print(" Time to OFF: ");
			Serial.print(TimeLeft);
			Serial.print("sec");
			Serial.println("");
		}
		tempo = 0;
	}
			
	if(tempo > iter)  //вывод каждую нную итерацию
	{
	   if(flag)
	   {
		   TimeLeft = (PreviousMillis+SleepTime-CurrentMillis)/1000+1;
		   Serial.print(" Time to ON: ");
		   Serial.print(TimeLeft);
		   Serial.print("sec");
		   Serial.println("");
	   }
	   else
	   {
		   TimeLeft = (PreviousMillis+WorkTime-CurrentMillis)/1000+1;
		   Serial.print(" Time to OFF: ");
		   Serial.print(TimeLeft);
		   Serial.print("sec");
		   Serial.println("");
	   }
		tempo = 0;
	}  
}
//-------------------------------------переходная функция вовремя переполнения milis();
void ResetTimeToWork()
{
	while(CurrentMillis<PreviousMillis)           //если текущее время меньше последней записи 
	{
		if(flag)                                         //и реле выключено
		{
			timeNextSwich = SleepTime-(4294967295-PreviousMillis);    //то находим время следующего переключения
			while(timeNextSwich>=CurrentMillis)                     //пока время следующего переключения больше текущего
			{
				CurrentMillis = millis();
				ResidueTime();
				
				Button();                                // если кнопка нажата, перезаписывается время последнего действа и выходим из функции ResetTimeToWork()!
				if(CurrentMillis>PreviousMillis)
					return;
				
				tempo++;                                 //для корректной работы ResidueTime();
			}
			flag = false;
			PreviousMillis = CurrentMillis;              //обновляем время изменения
			CurrentMillis = millis();                  
			return;
		}
		if(!flag)
		{
			timeNextSwich = WorkTime-(4294967295-PreviousMillis);
			while(timeNextSwich>=CurrentMillis)                           //пока время следующего переключения больше текущего
			{
				CurrentMillis = millis();
				ResidueTime();
				Button();
				if(CurrentMillis>PreviousMillis)
					return;
				tempo++;
			}
			flag = true;
			PreviousMillis = CurrentMillis;
			CurrentMillis = millis();
			return;
		}
	}
}
//--------------------------------------переключалка реле--------------------------------------------------
void SwichRelay()
{
	
	if(!flag)
	{
		digitalWrite(RelayPin, flag); // включаем реле
	}
	else
	{
		digitalWrite(RelayPin, flag);   // выключаем реле
	}
}