317 lines
7.5 KiB
C++
317 lines
7.5 KiB
C++
|
|
#define START_STATE 0
|
|
#define PREHEAT_STATE 1
|
|
#define RAMP_UP_STATE 2
|
|
#define TAL_FIRST_STATE 3
|
|
#define PEAK_STATE 4
|
|
#define TAL_SECOND_STATE 5
|
|
#define RAMP_DOWN_STATE 6
|
|
#define END_STATE 7
|
|
#define ERROR_STATE 8
|
|
|
|
// error conditions
|
|
#define E_DT_MIN 1 // temperatur dt too small
|
|
#define E_DT_MAX 2 // temperatur dt too big
|
|
#define E_TIME_MAX 4 // reflow process does take too long
|
|
#define E_PEAK_TOO_LONG 8 // package was roasted
|
|
|
|
// system time, timestamps and temperatures from sensors
|
|
__attribute__((__unused__)) static unsigned int time = 0; // profile seconds
|
|
__attribute__((__unused__)) static unsigned int temperatur = 25; // actual oven temp
|
|
__attribute__((__unused__)) static unsigned int last_temperatur = 25; // last oven temp
|
|
__attribute__((__unused__)) static unsigned int actual_dt = 0; // actual difference from last to actual temperatur
|
|
|
|
|
|
// profile temperatures
|
|
__attribute__((__unused__)) static unsigned int Ts_min = 150; // °C
|
|
__attribute__((__unused__)) static unsigned int Ts_max = 200; // °C
|
|
__attribute__((__unused__)) static unsigned int Tl = 217; // 217°C
|
|
__attribute__((__unused__)) static unsigned int Tp = 260; // 245-260°C
|
|
__attribute__((__unused__)) static unsigned int time_max = 480; // 8*60s max
|
|
|
|
|
|
// profile temp per second rates
|
|
__attribute__((__unused__)) static unsigned int ramp_up_rate_min = 0; // not used yet
|
|
__attribute__((__unused__)) static unsigned int ramp_up_rate_max = 50; // 3°C/s
|
|
__attribute__((__unused__)) static unsigned int ramp_down_max = 6; // 6°C/s max
|
|
__attribute__((__unused__)) static unsigned int ramp_down_min = 2; // 2°C/s max
|
|
|
|
|
|
// profile temp durations
|
|
__attribute__((__unused__)) static unsigned int Ts_duration = 100; // 60-180s
|
|
__attribute__((__unused__)) static unsigned int Tl_duration = 100; // 60-150s
|
|
__attribute__((__unused__)) static unsigned int Tp_duration = 30; // 20-40s
|
|
|
|
|
|
// timestamps of event beginnings/ends
|
|
__attribute__((__unused__)) static unsigned int Ts_min_time = 0;
|
|
__attribute__((__unused__)) static unsigned int Ts_max_time = 0;
|
|
__attribute__((__unused__)) static unsigned int Tl_time_start = 0;
|
|
__attribute__((__unused__)) static unsigned int Tl_time_end = 0;
|
|
__attribute__((__unused__)) static unsigned int Tp_time_start = 0;
|
|
__attribute__((__unused__)) static unsigned int Tp_time_end = 0;
|
|
|
|
|
|
// thermostat
|
|
__attribute__((__unused__)) static unsigned int set_min = 0;
|
|
__attribute__((__unused__)) static unsigned int set_max = 0;
|
|
__attribute__((__unused__)) static int set_dt_min = 0;
|
|
__attribute__((__unused__)) static int set_dt_max = 0;
|
|
|
|
|
|
// state machine
|
|
__attribute__((__unused__)) static byte state;
|
|
__attribute__((__unused__)) static boolean is_oven_heating = false;
|
|
__attribute__((__unused__)) static byte error_condition = 0;
|
|
|
|
// ui stuff
|
|
__attribute__((__unused__)) static boolean led_on = false;
|
|
|
|
void setup() {
|
|
Serial.begin(9600);
|
|
delay(2000);
|
|
set_start_state();
|
|
|
|
}
|
|
|
|
|
|
static void control_oven() {
|
|
if (temperatur < set_min && (!is_oven_heating)) {
|
|
is_oven_heating = true;
|
|
Serial.println("Oven turned on");
|
|
}
|
|
else if (temperatur > set_max && is_oven_heating) {
|
|
is_oven_heating = false;
|
|
Serial.println("Oven turned off");
|
|
}
|
|
}
|
|
|
|
static void set_temp(int min, int max, int dt_min, int dt_max) {
|
|
set_min = min;
|
|
set_max = max;
|
|
set_dt_min = dt_min;
|
|
set_dt_max = dt_max;
|
|
}
|
|
|
|
static void get_temp() {
|
|
last_temperatur = temperatur;
|
|
temperatur = int(float(analogRead(2)) * 0.2929);
|
|
actual_dt = temperatur - last_temperatur;
|
|
}
|
|
|
|
static void check_dt() {
|
|
if (actual_dt > set_dt_max) {
|
|
error_condition |= E_DT_MAX;
|
|
}
|
|
if (actual_dt < set_dt_min) {
|
|
error_condition |= E_DT_MIN;
|
|
}
|
|
}
|
|
|
|
static void print_debug() {
|
|
Serial.print("Time: ");
|
|
Serial.print(time);
|
|
Serial.print(", temperatur: ");
|
|
Serial.print(temperatur);
|
|
Serial.print(", last_temperatur: ");
|
|
Serial.print(last_temperatur);
|
|
Serial.print(", state: ");
|
|
Serial.print(state);
|
|
Serial.print(", Error: ");
|
|
Serial.println(error_condition);
|
|
}
|
|
|
|
// boolean check_max_duration() {
|
|
// if (time > time_max) {
|
|
// error_condition = E_TIME_MAX;
|
|
// return false;
|
|
// }
|
|
// }
|
|
/*
|
|
boolean check_Tl_duration() {
|
|
if (time > time_max) {
|
|
error_condition = E_TIME_MAX;
|
|
return false;
|
|
}
|
|
}*/
|
|
|
|
static void set_start_state() {
|
|
state = START_STATE;
|
|
get_temp();
|
|
last_temperatur = temperatur;
|
|
set_temp(Tp-5, Tp, 0, ramp_up_rate_max);
|
|
}
|
|
|
|
static void set_preheat_state() {
|
|
Serial.println("Changing state to PREHEAT_STATE");
|
|
state++;
|
|
}
|
|
|
|
static void set_ramp_up_state() {
|
|
Serial.println("Changed state to RAMP_UP_STATE");
|
|
state++;
|
|
}
|
|
|
|
static void set_tal_first_state() {
|
|
Serial.println("Changed state to TAL_FIRST_STATE");
|
|
state++;
|
|
}
|
|
|
|
static void set_peak_state() {
|
|
Serial.println("Changed state to PEAK_STATE");
|
|
state++;
|
|
}
|
|
|
|
static void set_tal_second_state() {
|
|
Serial.println("Changed state to TAL_SECOND_STATE");
|
|
set_temp(25, 25, -3, -6);
|
|
state++;
|
|
}
|
|
|
|
static void set_ramp_down_state() {
|
|
Serial.println("Changed state to RAMP_DOWN_STATE");
|
|
state++;
|
|
}
|
|
|
|
static void set_end_state() {
|
|
Serial.println("Changed state to END_STATE");
|
|
state++;
|
|
}
|
|
|
|
void set_error_state() {
|
|
if (state != ERROR_STATE) {
|
|
Serial.println("Changed state to ERROR_STATE");
|
|
set_temp(0, 0, 0, 0);
|
|
state = ERROR_STATE;
|
|
}
|
|
}
|
|
|
|
static void handle_start_state() {
|
|
Serial.println("START_STATE");
|
|
if (temperatur > Ts_min) {
|
|
Ts_min_time = time;
|
|
set_preheat_state();
|
|
}
|
|
}
|
|
|
|
|
|
|
|
static void handle_preheat_state() {
|
|
Serial.println("PREHEAT_STATE");
|
|
if (temperatur > Ts_max) {
|
|
Ts_max_time = time;
|
|
set_ramp_up_state();
|
|
}
|
|
}
|
|
|
|
static void handle_ramp_up_state() {
|
|
Serial.println("RAMP_UP_STATE");
|
|
if (temperatur > Tl) {
|
|
Tl_time_start = time;
|
|
state++;
|
|
}
|
|
}
|
|
|
|
static void handle_tal_first_state() {
|
|
Serial.println("TAL_FIRST_STATE");
|
|
if (temperatur > Tp - 5) {
|
|
Serial.println("Changed state to PEAK_STATE");
|
|
Tp_time_start = time;
|
|
set_peak_state();
|
|
}
|
|
}
|
|
|
|
static void handle_peak_state() {
|
|
Serial.println("PEAK_STATE");
|
|
|
|
if (time - Tp_time_start > Tp_duration) {
|
|
Tp_time_end = time;
|
|
set_tal_second_state();
|
|
}
|
|
}
|
|
|
|
|
|
static void handle_tal_second_state() {
|
|
if (temperatur < Tl) {
|
|
set_ramp_down_state();
|
|
}
|
|
}
|
|
|
|
static void handle_ramp_down_state() {
|
|
if (temperatur < Ts_min) {
|
|
Serial.println("Changed state to END_STATE");
|
|
set_end_state();
|
|
}
|
|
}
|
|
|
|
|
|
static void handle_error_state() {
|
|
if (led_on) {
|
|
digitalWrite(13, LOW);
|
|
led_on = false;
|
|
}
|
|
else {
|
|
digitalWrite(13, HIGH);
|
|
led_on = true;
|
|
}
|
|
if (error_condition & E_DT_MIN)
|
|
Serial.print("Error: delta °K/second too low");
|
|
if (error_condition & E_DT_MAX)
|
|
Serial.print("Error: delta °K/second too big");
|
|
}
|
|
|
|
|
|
void loop() {
|
|
time = millis() / 1000;
|
|
get_temp();
|
|
check_dt();
|
|
|
|
if (error_condition) {
|
|
set_error_state();
|
|
}
|
|
else {
|
|
print_debug();
|
|
}
|
|
|
|
|
|
switch (state) {
|
|
case START_STATE:
|
|
handle_start_state();
|
|
break;
|
|
case PREHEAT_STATE:
|
|
handle_preheat_state();
|
|
break;
|
|
case RAMP_UP_STATE:
|
|
handle_ramp_up_state();
|
|
break;
|
|
case TAL_FIRST_STATE:
|
|
handle_tal_first_state();
|
|
break;
|
|
case PEAK_STATE:
|
|
handle_peak_state();
|
|
break;
|
|
case TAL_SECOND_STATE:
|
|
Tl_time_end = time;
|
|
handle_tal_second_state();
|
|
break;
|
|
case RAMP_DOWN_STATE:
|
|
handle_ramp_down_state();
|
|
break;
|
|
case END_STATE:
|
|
Serial.println("END_STATE");
|
|
while(true) {
|
|
continue;
|
|
}
|
|
break;
|
|
case ERROR_STATE:
|
|
handle_error_state();
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
|
|
control_oven();
|
|
delay(1000);
|
|
}
|
|
|