/*
 * Modes.c
 *
 *  Created on: 17 Sep 2016
 *      Author: Ralim <ralim@ralimtek.com>
 */
#include "Modes.h"
uint8_t CalStatus = 0;
//This does the required processing and state changes
void ProcessUI() {
	uint8_t Buttons = getButtons(); //read the buttons status
	static uint32_t lastModeChange = 0;
	if (millis() - getLastButtonPress() < 30)
		Buttons = 0;
	else if (Buttons != 0) {
		resetLastButtonPress();
		resetButtons();
	}
	//rough prevention for de-bouncing and allocates settling time

	switch (operatingMode) {
	case STARTUP:
		if (Buttons == (BUT_A | BUT_B)) {
			operatingMode = THERMOMETER;
		} else if (Buttons == BUT_A) {
			//A key pressed so we are moving to soldering mode
			operatingMode = SOLDERING;
		} else if (Buttons == BUT_B) {
			//B Button was pressed so we are moving to the Settings menu
			operatingMode = SETTINGS;
		}
		break;
	case SOLDERING:
		//We need to check the buttons if we need to jump out
		if (Buttons == BUT_A || Buttons == BUT_B) {
			//A or B key pressed so we are moving to temp set
			operatingMode = TEMP_ADJ;
		} else if (Buttons == (BUT_A | BUT_B)) {

			//Both buttons were pressed, exit back to the cooling screen
			operatingMode = COOLING;

		} else {
			//We need to check the timer for movement in case we need to goto idle
			if (systemSettings.movementEnabled)
				if (millis() - getLastMovement()
						> (systemSettings.SleepTime * 60000)) {
					if (millis() - getLastButtonPress()
							> (systemSettings.SleepTime * 60000)) {
						operatingMode = SLEEP;
						return;
					}
				}
			uint16_t voltage = readDCVoltage(systemSettings.voltageDiv); //get X10 voltage
			if ((voltage / 10) < systemSettings.cutoutVoltage) {
				operatingMode = UVLOWARN;
				lastModeChange = millis();
			}
			//Update the PID Loop
			int32_t newOutput = computePID(systemSettings.SolderingTemp);
			setIronTimer(newOutput);
		}
		break;
	case TEMP_ADJ:
		if (Buttons == BUT_A) {
			//A key pressed so we are moving down in temp

			if (systemSettings.SolderingTemp > 1000)
				systemSettings.SolderingTemp -= 100;
		} else if (Buttons == BUT_B) {
			//B key pressed so we are moving up in temp
			if (systemSettings.SolderingTemp < 4500)
				systemSettings.SolderingTemp += 100;
		} else {
			//we check the timeout for how long the buttons have not been pushed
			//if idle for > 3 seconds then we return to soldering
			//Or if both buttons pressed
			if ((millis() - getLastButtonPress() > 2000)
					|| Buttons == (BUT_A | BUT_B)) {
				operatingMode = SOLDERING;
				saveSettings();
			}
		}
		break;
	case SETTINGS:
		//Settings is the mode with the most logic
		//Here we are in the menu so we need to increment through the sub menus / increase the value

		if (Buttons & BUT_A) {
			//A key iterates through the menu
			if (settingsPage == SETTINGSOPTIONSCOUNT) {
				//Roll off the end
				settingsPage = 0;				//reset
				operatingMode = STARTUP;		//reset back to the startup
				saveSettings();					//Save the settings
			} else
				++settingsPage;					//move to the next option
		} else if (Buttons & BUT_B) {
			resetLastButtonPress();
			//B changes the value selected
			switch (settingsPage) {
			case UVCO:
				//we are incrementing the cutout voltage
				systemSettings.cutoutVoltage += 1;		//Go up 1V at a jump
				if (systemSettings.cutoutVoltage > 24)
					systemSettings.cutoutVoltage = 10;
				break;
			case SLEEP_TEMP:
				systemSettings.SleepTemp += 100;		//Go up 10c at a time
				if (systemSettings.SleepTemp > 3000)
					systemSettings.SleepTemp = 1000;//cant sleep higher than 300
				break;
			case SLEEP_TIME:
				++systemSettings.SleepTime;		//Go up 1 minute at a time
				if (systemSettings.SleepTime > 30)
					systemSettings.SleepTime = 1;	//cant set time over 30 mins
				//Remember that ^ is the time of no movement
				break;
			case MOTIONDETECT:
				systemSettings.movementEnabled =
						!systemSettings.movementEnabled;
				break;
			case TEMPDISPLAY:
				systemSettings.displayTempInF = !systemSettings.displayTempInF;
				break;
			case LEFTY:
				systemSettings.flipDisplay = !systemSettings.flipDisplay;
				break;
			case MOTIONSENSITIVITY:
				systemSettings.sensitivity += 0x10;
				if (systemSettings.sensitivity > 0x20)
					systemSettings.sensitivity = 0;		//reset to high on wrap

				break;
			default:
				break;
			}
		}
		break;
	case SLEEP:
		//The iron is sleeping at a lower temperature due to lack of movement
		if (Buttons & BUT_A) {
			//A Button was pressed so we are moving back to soldering
			operatingMode = SOLDERING;
			return;
		} else if (Buttons & BUT_B) {
			//B Button was pressed so we are moving back to soldering
			operatingMode = SOLDERING;
			return;
		} else if (systemSettings.movementEnabled)
			if (millis() - getLastMovement() < 1000) {//moved in the last second
				operatingMode = SOLDERING; //Goto active mode again
				return;
			}
		//else if nothing has been pushed we need to compute the PID to keep the iron at the sleep temp
		int32_t newOutput = computePID(systemSettings.SleepTemp);
		setIronTimer(newOutput);
		break;
	case COOLING: {
		setIronTimer(0); //turn off heating
		//This mode warns the user the iron is still cooling down
		uint16_t temp = readIronTemp(0, 1, 0xFFFF); //take a new reading as the heater code is not taking new readings
		if (temp < 400) { //if the temp is < 40C then we can go back to IDLE
			operatingMode = STARTUP;
		} else if (Buttons & (BUT_A | BUT_B)) { //we check if the user has pushed a button to ack
			//Either button was pushed
			operatingMode = STARTUP;
		}
	}
		break;
	case UVLOWARN:
		//We are here if the DC voltage went too low
		//We want to jump back to IDLE after a bit
		if (millis() - lastModeChange > 3000) {		//its been 3 seconds
			operatingMode = STARTUP;		//jump back to idle mode
		}
		break;
	case THERMOMETER: {
		//This lets the user check the tip temp without heating the iron.. And eventually calibration will be added here

		if (Buttons == BUT_A) {
			//Single button press, cycle over to the DC display
			CalStatus = 0;
			operatingMode = DCINDISP;
		} else if (Buttons == BUT_B) {
			CalStatus = 0;
			operatingMode = TEMPCAL;
		} else if (Buttons == (BUT_A | BUT_B)) {
			//If the user is holding both button, exit the  screen
			operatingMode = STARTUP;
		}

	}
		break;
	case DCINDISP: {
		//This lets the user check the input voltage
		if (CalStatus == 0) {
			if (Buttons == BUT_A) {
				//Single button press, cycle over to the temp display
				operatingMode = THERMOMETER;
			} else if (Buttons == BUT_B) {
				//dc cal mode
				CalStatus = 1;
			} else if (Buttons == (BUT_A | BUT_B)) {
				//If the user is holding both button, exit the  screen
				operatingMode = STARTUP;
			}
		} else {
			//User is calibrating the dc input
			if (Buttons == BUT_A) {
				if (!systemSettings.flipDisplay)
					systemSettings.voltageDiv++;
				else
					systemSettings.voltageDiv--;
			} else if (Buttons == BUT_B) {
				if (!systemSettings.flipDisplay)
					systemSettings.voltageDiv--;
				else
					systemSettings.voltageDiv++;
			} else if (Buttons == (BUT_A | BUT_B)) {
				CalStatus = 0;
				saveSettings();
			}
			if (systemSettings.voltageDiv < 120)
				systemSettings.voltageDiv = 160;
			else if (systemSettings.voltageDiv > 160)
				systemSettings.voltageDiv = 120;
		}

	}
		break;
	case TEMPCAL: {
		if (Buttons == BUT_B) {
			//Single button press, cycle over to the DC IN
			operatingMode = THERMOMETER;
		} else if (Buttons == BUT_A) {
			//Try and calibrate
			if (CalStatus == 0) {
				if ((readTipTemp() < 300) && (readSensorTemp() < 300)) {
					CalStatus = 1;
					systemSettings.tempCalibration = readTipTemp();
					saveSettings();
				} else {
					CalStatus = 2;
				}
			}
		} else if (Buttons == (BUT_A | BUT_B)) {
			//If the user is holding both button, exit the  screen
			operatingMode = STARTUP;
		}

	}
		break;
	default:
		break;
	}
}
/*
 * Draws the temp with temp conversion if needed
 */
void drawTemp(uint16_t temp, uint8_t x) {
	if (systemSettings.displayTempInF)
		temp = (temp * 9 + 1600) / 5;/*Convert to F -> T*(9/5)+32*/
	if (temp % 10 > 5)
		temp += 10;		//round up
	OLED_DrawThreeNumber(temp / 10, x);
}

/*
 * Performs all the OLED drawing for the current operating mode
 */
void DrawUI() {
	uint16_t temp = readIronTemp(0, 0, 0xFFFF);
	switch (operatingMode) {
	case STARTUP:
		//We are chilling in the idle mode
		//Check if movement in the last 5 minutes , if not sleep OLED
		if (millis() - getLastMovement() > (5 * 60 * 1000)
				&& (millis() - getLastButtonPress() > (5 * 60 * 1000))) {
			//OLED off
			Oled_DisplayOff();
		} else {
			Oled_DisplayOn();
			//OLED_DrawString("  IDLE  ", 8);		//write the word IDLE
			OLED_DrawIDLELogo();
		}
		break;
	case SOLDERING:
		//The user is soldering
	{
		if (getIronTimer() == 0) {
			OLED_DrawChar('C', 5);
		} else {
			if (getIronTimer() < 900) {
				OLED_DrawChar(' ', 5);
			} else {		//we are heating
				OLED_DrawChar('H', 5);
			}
		}
		drawTemp(temp, 0);
		OLED_DrawChar(' ', 3);
		OLED_DrawChar(' ', 4);
		OLED_DrawChar(' ', 6);
		OLED_DrawChar(' ', 7);

	}
		break;
	case TEMP_ADJ:
		//We are prompting the user to change the temp so we draw the current setpoint temp
		//With the nifty arrows

		OLED_DrawChar(' ', 0);
		OLED_DrawChar('<', 1);
		drawTemp(systemSettings.SolderingTemp, 2);
		OLED_DrawChar(' ', 5);
		OLED_DrawChar(' ', 6);
		OLED_DrawChar('>', 7);

		break;
	case SETTINGS:
		//We are prompting the user the setting name

		switch (settingsPage) {
		case UVCO:
			OLED_DrawString("UVCO ", 5);
			OLED_DrawTwoNumber(systemSettings.cutoutVoltage, 5);
			OLED_DrawChar('V', 7);
			break;
		case SLEEP_TEMP:
			OLED_DrawString("STMP ", 5);
			OLED_DrawThreeNumber(systemSettings.SleepTemp / 10, 5);
			break;
		case SLEEP_TIME:
			OLED_DrawString("STIME ", 6);
			OLED_DrawTwoNumber(systemSettings.SleepTime, 6);
			break;
		case MOTIONDETECT:/*Toggle the mode*/
			if (systemSettings.movementEnabled)
				OLED_DrawString("MOTION T", 8);
			else
				OLED_DrawString("MOTION F", 8);
			break;
		case TEMPDISPLAY:/*Are we showing in C or F ?*/
			if (systemSettings.displayTempInF)
				OLED_DrawString("TMPUNT F", 8);
			else
				OLED_DrawString("TMPUNT C", 8);
			break;

		case LEFTY:

			if (systemSettings.flipDisplay)
				OLED_DrawString("FLPDSP T", 8);
			else
				OLED_DrawString("FLPDSP F", 8);
			break;
		case MOTIONSENSITIVITY:
			switch (systemSettings.sensitivity) {
			case MOTION_HIGH:
				OLED_DrawString("SENSE H ", 8);
				break;
			case MOTION_MED:
				OLED_DrawString("SENSE M ", 8);
				break;
			case MOTION_LOW:
				OLED_DrawString("SENSE L ", 8);
				break;
			default:
				OLED_DrawString("SENSE   ", 8);
				break;
			}

			break;
		default:
			break;
		}
		break;
	case SLEEP:
		//The iron is in sleep temp mode
		//Draw in temp and sleep
		OLED_DrawString("SLP", 3);
		drawTemp(temp, 4);
		break;
	case COOLING:
		//We are warning the user the tip is cooling
		OLED_DrawString("COOL", 4);
		drawTemp(temp, 5);
		break;
	case UVLOWARN:
		OLED_DrawString("LOW VOLT", 8);
		break;
	case THERMOMETER:
		temp = readIronTemp(0, 1, 0xFFFF);	//Force a reading as heater is off
		OLED_DrawString("TEMP ", 5);//extra one to it clears the leftover 'L' from IDLE
		drawTemp(temp, 5);
		break;
	case DCINDISP: {
		uint16_t voltage = readDCVoltage(systemSettings.voltageDiv); //get X10 voltage

		if (CalStatus == 0 || ((millis() % 1000) > 500)) {
			OLED_DrawString("IN", 2);
			OLED_DrawChar((voltage / 100) % 10, 2);
			voltage -= (voltage / 100) * 100;
			OLED_DrawChar((voltage / 10) % 10, 3);
			voltage -= (voltage / 10) * 10;
			OLED_DrawChar('.', 4);
			OLED_DrawChar(voltage % 10, 5);
			OLED_DrawChar('V', 6);
			OLED_DrawChar(' ', 7);
		} else {
			OLED_DrawString("IN      ", 8);
		}
	}
		break;
	case TEMPCAL: {

		if (CalStatus == 0) {
			OLED_DrawString("CAL TEMP", 8);
		} else if (CalStatus == 1) {
			OLED_DrawString("CAL OK  ", 8);
		} else if (CalStatus == 2) {
			OLED_DrawString("CAL FAIL", 8);
		}
	}

		break;
	default:
		break;
	}
}