#define DEFAULT_BOOT_TO_BREW 0

#define DEFAULT_TEMP_UNITS TEMP_UNITS_FAHRENHEIT

#define DEFAULT_WINDUP_GUARD 10

#define DEFAULT_K_P 10

#define DEFAULT_K_I 1

#define DEFAULT_K_D 1

#define DEFAULT_TEMP_OFFSET 0

#define DEFAULT_IGNORE_ERROR 0

#define DEFAULT_SETPOINT_BREW 70

#define DEFAULT_SETPOINT_STEAM 70

#endif

// vim:softtabstop=4 shiftwidth=4 expandtab 

// Buttonpress macros

#define SW_BTN_PRESSED (sw_btn_last == 0 && sw_btn == 1) // rising edge on buttonpress

#define SW_UP_PRESSED (sw_up_last == 0 && sw_up == 1)

#define SW_DOWN_PRESSED (sw_down_last == 0 && sw_down == 1)

#define SW_LEFT_PRESSED (sw_left_last == 0 && sw_left == 1)

#define SW_RIGHT_PRESSED (sw_right_last == 0 && sw_right == 1)

// States

static uint8_t trigger_drawsetpoint = 1;

static int16_t last_temp = 21245;

static int16_t last_temp_frac = 21245;

static uint8_t goto_mode = MODE_HEAT;

static uint8_t reset_mode = RESET_REBOOT;

// Display state machine

void display_process(therm_settings_t* set, therm_status_t* status)

{

    uint8_t state_changed = status->state != last_state;

    last_state = status->state;

    uint8_t temp_changed = status->temp != last_temp || status->temp_frac != last_temp_frac;

            if(set->val.plant_type == PLANT_HEATER)

                ssd1306_drawstring("Heater", 1, 60);

            else

                ssd1306_drawstring("Cooler", 1, 60);

            ssd1306_drawstring("Press to accept", 3, 40);

            // Button handler

            if(SW_BTN_PRESSED) {

                if(set->val.control_mode == MODE_PID)

                    status->state = STATE_SETP;

                else

            }

            else if (!HAL_GPIO_ReadPin(SW_UP)) {

                set->val.plant_type = PLANT_COOLER;

            }

            else if(!HAL_GPIO_ReadPin(SW_DOWN)) {

                set->val.plant_type = PLANT_HEATER;

            }

            // Event Handler

            // N/A

        } break;

        case STATE_SETP:

        {

            // Write text to OLED

            // [ therm :: set p ]

            // [ p = 12         ]

            ssd1306_drawstring("Proportional", 0, 40);

            ssd1306_drawlogo();

            char tempstr[6];

            itoa(set->val.k_p, tempstr, 10);

            ssd1306_drawstring("P=", 1, 45);

            ssd1306_drawstring("    ", 1, 57);

void flash_load_defaults(therm_settings_t* torestore) {

	torestore->val.boottobrew = DEFAULT_BOOT_TO_BREW;

	torestore->val.temp_units = DEFAULT_TEMP_UNITS;

	torestore->val.windup_guard = DEFAULT_WINDUP_GUARD;

	torestore->val.k_p = DEFAULT_K_P;

	torestore->val.k_i = DEFAULT_K_I;

	torestore->val.k_d = DEFAULT_K_D;

	torestore->val.temp_offset = DEFAULT_TEMP_OFFSET;

	torestore->val.ignore_error = DEFAULT_IGNORE_ERROR;

	torestore->val.setpoint_brew = DEFAULT_SETPOINT_BREW;

	torestore->val.setpoint_steam = DEFAULT_SETPOINT_STEAM;

}

static void __flash_write(therm_settings_t* tosave)

{

    // Erase mem

    HAL_FLASH_Unlock();

    // Erase the FLASH pages

    FLASH_EraseInitTypeDef erase;

    erase.TypeErase = TYPEERASE_PAGES;

    erase.PageAddress = (uint32_t) eeprom;

    erase.NbPages = 1;

    HAL_Delay(2000);

    ssd1306_clearscreen();

    // Soft timers

    uint32_t last_ssr_on = 0;

    uint32_t last_vcp_tx = 0;

    uint32_t last_led = 0;

    uint32_t last_pid = 0;

    uint32_t last_thermostat = 0;

    int16_t ssr_output = 0; // Duty cycle of ssr, 0 to SSR_PERIOD 

    // Main loop

    while(1)

    {

        // Process sensor inputs

        if(HAL_GetTick() - last_led > 400) 

        {

            last_led = HAL_GetTick();

        }

        if(set.val.control_mode == MODE_PID && (HAL_GetTick() - last_pid > PID_PERIOD))

        {

            #ifdef MAX31865_RTD_SENSOR

            max31865_readtemp(spi_get(), &set, &status);

			#else

			max31855_readtemp(spi_get(), &set, &status); // Read MAX31855

			#endif

            // TODO: Migrate this FxP conversion to the readtemp code or similar

            int8_t temp_frac = status.temp_frac > 9 ? status.temp_frac / 10 : status.temp_frac;

            temp_frac = status.temp > 0 ? temp_frac : temp_frac * -1;

            int32_t temp = (status.temp * 10) + temp_frac;

            // EMZ FIXME: This could be way simpler

            // EMZ: TODO: Refactor to output_enabled or something

            {

                // EMZ TODO: functionalize this

            	// put ssr output on display

                ssd1306_drawstring("      ", 0, 90); //fixme: this is bad, but I can't get the old digits to clear otherwise

                char tempstr[6];

                itoa(ssr_output, tempstr, 10);

                ssd1306_drawstring(tempstr, 0, 90);

                HAL_GPIO_WritePin(SSR_PIN, 1);

                HAL_GPIO_WritePin(LED_POWER, 1);

        uint32_t boottobrew;

        uint32_t temp_units;

        uint32_t windup_guard;

        uint32_t k_p;

        uint32_t k_i;

        uint32_t k_d;

        int32_t temp_offset;

        uint32_t ignore_error;

        int32_t setpoint_brew;

        int32_t setpoint_steam;

        uint32_t control_mode;

        uint32_t plant_type;

    } val;

    uint16_t data[128];

} therm_settings_t;

enum tempunits {

    TEMP_UNITS_CELSIUS = 0,

    TEMP_UNITS_FAHRENHEIT,

};

enum state {

    STATE_IDLE = 0,

    STATE_SETMODE,

    STATE_SETPLANTTYPE,

    STATE_SETP,

    STATE_SETI,

    STATE_SETD,

    STATE_SETSTEPS,

    STATE_SETWINDUP,

    STATE_SETBOOTTOBREW,

    STATE_SETUNITS,

    STATE_SETTEMPOFFSET,

    STATE_PREHEAT,

    STATE_MAINTAIN,