MZJ / Mbed 2 deprecated shaun_larada

Aes encryption code

Dependencies:   Crypto USBDevice mbed

Fork of larada by MZJ

main.cpp@2:35e620097381, 2016-03-02 (annotated)

Committer:
stupid
Date:
Wed Mar 02 08:52:50 2016 +0000
Revision:
2:35e620097381
Parent:
1:ccb26dd9845a
Child:
3:cff2f80f0a42
commit before publishing

Who changed what in which revision?

UserRevisionLine numberNew contents of line
stupid 0:aaf22a04f350 1 #include "mbed.h"
stupid 0:aaf22a04f350 2 #include "USBSerial.h"
stupid 0:aaf22a04f350 3 #include "IAP.h"
stupid 0:aaf22a04f350 4
stupid 1:ccb26dd9845a 5 // #define SERIAL //comment for USB operation, uncomment for serial
stupid 0:aaf22a04f350 6 #define CALIBRATE 0
stupid 0:aaf22a04f350 7 #define FUNCTION_CHECK 0
stupid 0:aaf22a04f350 8
stupid 1:ccb26dd9845a 9 // debounce duration for ON/OFF switch
stupid 1:ccb26dd9845a 10 #define ON_OFF_DEBOUNCE 3000
stupid 1:ccb26dd9845a 11
stupid 0:aaf22a04f350 12 // longest user command we will accept
stupid 0:aaf22a04f350 13 #define MAX_COMMAND_LEN 64
stupid 0:aaf22a04f350 14
stupid 0:aaf22a04f350 15 // where to start reading stored values from the EEPROM
stupid 0:aaf22a04f350 16 #define BASE_ADDRESS 1
stupid 0:aaf22a04f350 17
stupid 1:ccb26dd9845a 18 // temperature control stuff //
stupid 0:aaf22a04f350 19 // fixed values
stupid 0:aaf22a04f350 20 #define CONTROL_INTERRUPT 1000 // every 1ms
stupid 0:aaf22a04f350 21 #define MAX_DUTY 100 // This is both the number of times the heater_control interrupt will run per control period and the max amount of interrupts the heater triac can be on.
stupid 0:aaf22a04f350 22
stupid 0:aaf22a04f350 23 // adjustable values
stupid 0:aaf22a04f350 24 #define DEFAULT_FILTER 0.05 // first order digital filter parameter, should be [0.0 - 1]. less means filter more, a value of 1 should turn it off
stupid 0:aaf22a04f350 25 //#define INITIAL_DUTY 25 // 25% duty generally results in a few degrees under 57C output for the ambient temperatures I've been testing at
stupid 0:aaf22a04f350 26 #define DEFAULT_INITIAL_DUTY 45
stupid 1:ccb26dd9845a 27 #define DEFAULT_NOMINAL_DUTY 28 // 11% duty is a good set point for Beta init (testing at 20C ambient)
stupid 0:aaf22a04f350 28 //#define SETPOINT 435 // this results in roughly 57C at the tines on the Alphas (really 53)
stupid 1:ccb26dd9845a 29 #define DEFAULT_SETPOINT 58 //seems like there is a ~4C temperature drop between the sensor and the outside of the tips
stupid 0:aaf22a04f350 30 #define DEFAULT_TOLERANCE 2 // if we are within this many ADC counts of the setpoint don't make any changes to the duty cycle
stupid 0:aaf22a04f350 31 //#define DUTY_TOO_LARGE 40 // If the duty gets larger than this we have problems (Alphas)
stupid 0:aaf22a04f350 32 #define DEFAULT_DUTY_TOO_LARGE 70 // If the duty gets larger than this we have problems (Betas) -> 65 duty should result in roughly 62C tip temps
stupid 0:aaf22a04f350 33 //#define DUTY_TOO_LARGE 85 // For testing
stupid 1:ccb26dd9845a 34 #define DEFAULT_TEMP_LIMIT_LOWER 12 // If the temperature measures too low during operation we are either doing a bad job or have a faulty temperature sensor
stupid 1:ccb26dd9845a 35 //#define DEFAULT_TEMP_LIMIT_LOWER 0 // For testing
stupid 0:aaf22a04f350 36 //#define TEMP_LIMIT_UPPER 485 // No burning allowed (Alphas)
stupid 1:ccb26dd9845a 37 #define DEFAULT_TEMP_LIMIT_UPPER 65 // No burning allowed (Betas)
stupid 0:aaf22a04f350 38
stupid 0:aaf22a04f350 39 float filter = DEFAULT_FILTER;
stupid 0:aaf22a04f350 40 uint8_t initial_duty = DEFAULT_INITIAL_DUTY;
stupid 0:aaf22a04f350 41 uint8_t nominal_duty = DEFAULT_NOMINAL_DUTY;
stupid 0:aaf22a04f350 42 uint16_t setpoint = DEFAULT_SETPOINT;
stupid 0:aaf22a04f350 43 uint8_t tolerance = DEFAULT_TOLERANCE;
stupid 0:aaf22a04f350 44 uint8_t duty_too_large = DEFAULT_DUTY_TOO_LARGE;
stupid 0:aaf22a04f350 45 uint16_t temp_limit_lower = DEFAULT_TEMP_LIMIT_LOWER;
stupid 0:aaf22a04f350 46 uint16_t temp_limit_upper = DEFAULT_TEMP_LIMIT_UPPER;
stupid 0:aaf22a04f350 47
stupid 0:aaf22a04f350 48 enum State {
stupid 0:aaf22a04f350 49 IDLE,
stupid 0:aaf22a04f350 50 WAIT_FOR_TIP,
stupid 0:aaf22a04f350 51 INITIAL_RAMP,
stupid 0:aaf22a04f350 52 ACTIVE,
stupid 1:ccb26dd9845a 53 DONE,
stupid 0:aaf22a04f350 54 ERROR,
stupid 0:aaf22a04f350 55 };
stupid 0:aaf22a04f350 56
stupid 0:aaf22a04f350 57 enum Heater_State {
stupid 0:aaf22a04f350 58 ON,
stupid 0:aaf22a04f350 59 OFF,
stupid 0:aaf22a04f350 60 };
stupid 0:aaf22a04f350 61
stupid 0:aaf22a04f350 62 // not used yet
stupid 0:aaf22a04f350 63 enum Error {
stupid 0:aaf22a04f350 64 NONE,
stupid 0:aaf22a04f350 65 TEMP_TOO_LOW,
stupid 0:aaf22a04f350 66 TEMP_TOO_HIGH,
stupid 0:aaf22a04f350 67 DUTY_TOO_LARGE,
stupid 0:aaf22a04f350 68 };
stupid 0:aaf22a04f350 69
stupid 0:aaf22a04f350 70 // Heater control pins
stupid 0:aaf22a04f350 71 DigitalOut fan(P0_22);
stupid 0:aaf22a04f350 72 DigitalOut heater_pin(P1_27);
stupid 0:aaf22a04f350 73 AnalogIn temp_sense(P0_16);
stupid 0:aaf22a04f350 74
stupid 0:aaf22a04f350 75 // LED pins
stupid 0:aaf22a04f350 76 DigitalInOut empty_led(P0_10);
stupid 0:aaf22a04f350 77 DigitalInOut fuel_gage_1(P0_9);
stupid 0:aaf22a04f350 78 DigitalInOut fuel_gage_2(P0_8);
stupid 0:aaf22a04f350 79 DigitalInOut fuel_gage_3(P1_21);
stupid 0:aaf22a04f350 80 DigitalInOut fuel_gage_4(P1_31);
stupid 0:aaf22a04f350 81 DigitalOut tip_light(P1_14);
stupid 0:aaf22a04f350 82
stupid 1:ccb26dd9845a 83 // Other pins
stupid 0:aaf22a04f350 84 DigitalIn tip_sensor(P0_14);
stupid 1:ccb26dd9845a 85 DigitalIn on_off(P1_28);
stupid 0:aaf22a04f350 86
stupid 0:aaf22a04f350 87 #define ON_TIME_S 2700L // The device is active for 45 minutes
stupid 0:aaf22a04f350 88 //#define ON_TIME_S 150L
stupid 0:aaf22a04f350 89 #define RED_LED_ON_TIME_S 300L // The red LED is active for the last 5 minutes
stupid 0:aaf22a04f350 90 //#define RED_LED_ON_TIME_S 30L
stupid 1:ccb26dd9845a 91 #define TIP_FLASH_INTERVAL_S 25L // How often the tip will flash
stupid 0:aaf22a04f350 92 //Serial pc(0x1f00, 0x2012, 0x0001, false);
stupid 0:aaf22a04f350 93
stupid 0:aaf22a04f350 94 #ifdef SERIAL
stupid 0:aaf22a04f350 95 Serial pc(P0_19, P0_18); // tx, rx
stupid 0:aaf22a04f350 96 #else
stupid 0:aaf22a04f350 97 USBSerial pc(0x1f00, 0x2012, 0x0001);
stupid 0:aaf22a04f350 98 #endif
stupid 0:aaf22a04f350 99
stupid 0:aaf22a04f350 100 Ticker control_interrupt;
stupid 0:aaf22a04f350 101 Ticker check_limits_interrupt;
stupid 0:aaf22a04f350 102 Ticker temperature_interrupt;
stupid 0:aaf22a04f350 103 Ticker tick_interrupt;
stupid 0:aaf22a04f350 104
stupid 0:aaf22a04f350 105 volatile Heater_State heater = OFF;
stupid 1:ccb26dd9845a 106 volatile State state = IDLE;
stupid 0:aaf22a04f350 107 volatile Error error_state = NONE;
stupid 0:aaf22a04f350 108
stupid 0:aaf22a04f350 109 volatile uint8_t duty = DEFAULT_INITIAL_DUTY;
stupid 0:aaf22a04f350 110 volatile float temperature = 0.0;
stupid 0:aaf22a04f350 111 unsigned long start_time = 0L;
stupid 0:aaf22a04f350 112 unsigned long current_time = 0L;
stupid 0:aaf22a04f350 113 bool connected = false;
stupid 0:aaf22a04f350 114 volatile uint32_t millis = 0;
stupid 0:aaf22a04f350 115
stupid 0:aaf22a04f350 116 void loop(void);
stupid 0:aaf22a04f350 117 void calibrate(bool first);
stupid 0:aaf22a04f350 118 void interpret(char parameter, int value);
stupid 0:aaf22a04f350 119 void spin_lights(bool first);
stupid 0:aaf22a04f350 120
stupid 1:ccb26dd9845a 121 //INTERRUPT - increment this every ms since the normal mbed timer returns an int and we need an unsigned type
stupid 0:aaf22a04f350 122 void tick(void) {millis++;}
stupid 0:aaf22a04f350 123
stupid 0:aaf22a04f350 124 uint32_t get_time(void){
stupid 0:aaf22a04f350 125 uint32_t copy = 0;
stupid 0:aaf22a04f350 126 __disable_irq();
stupid 0:aaf22a04f350 127 copy = millis;
stupid 0:aaf22a04f350 128 __enable_irq();
stupid 0:aaf22a04f350 129 return copy;
stupid 0:aaf22a04f350 130 }
stupid 0:aaf22a04f350 131
stupid 0:aaf22a04f350 132 uint8_t get_duty(void){
stupid 0:aaf22a04f350 133 __disable_irq();
stupid 0:aaf22a04f350 134 uint8_t duty_copy = duty;
stupid 0:aaf22a04f350 135 __enable_irq();
stupid 0:aaf22a04f350 136 return duty_copy;
stupid 0:aaf22a04f350 137 }
stupid 0:aaf22a04f350 138
stupid 0:aaf22a04f350 139 void set_duty(uint8_t new_duty){
stupid 0:aaf22a04f350 140 __disable_irq();
stupid 0:aaf22a04f350 141 duty = new_duty;
stupid 0:aaf22a04f350 142 __enable_irq();
stupid 0:aaf22a04f350 143 }
stupid 0:aaf22a04f350 144
stupid 0:aaf22a04f350 145 float get_temperature(void){
stupid 0:aaf22a04f350 146 __disable_irq();
stupid 0:aaf22a04f350 147 float temperature_copy = temperature;
stupid 0:aaf22a04f350 148 __enable_irq();
stupid 0:aaf22a04f350 149 return temperature_copy;
stupid 0:aaf22a04f350 150 }
stupid 0:aaf22a04f350 151
stupid 0:aaf22a04f350 152 //pull the settings saved to flash into memory
stupid 0:aaf22a04f350 153 void read_settings(void){
stupid 0:aaf22a04f350 154 uint8_t address = BASE_ADDRESS;
stupid 0:aaf22a04f350 155 uint16_t filter_temp = 0;
stupid 0:aaf22a04f350 156
stupid 0:aaf22a04f350 157 IAP iap;
stupid 0:aaf22a04f350 158
stupid 0:aaf22a04f350 159 iap.read_eeprom((char*)address, (char*)&filter_temp, sizeof(filter_temp));
stupid 0:aaf22a04f350 160 address += sizeof(filter_temp);
stupid 0:aaf22a04f350 161 filter = (float)filter_temp/100;
stupid 0:aaf22a04f350 162 iap.read_eeprom((char*)address, (char*)&initial_duty, sizeof(initial_duty));
stupid 0:aaf22a04f350 163 address += sizeof(initial_duty);
stupid 0:aaf22a04f350 164 iap.read_eeprom((char*)address, (char*)&setpoint, sizeof(setpoint));
stupid 0:aaf22a04f350 165 address += sizeof(setpoint);
stupid 0:aaf22a04f350 166 iap.read_eeprom((char*)address, (char*)&tolerance, sizeof(tolerance));
stupid 0:aaf22a04f350 167 address += sizeof(tolerance);
stupid 0:aaf22a04f350 168 iap.read_eeprom((char*)address, (char*)&duty_too_large, sizeof(duty_too_large));
stupid 0:aaf22a04f350 169 address += sizeof(duty_too_large);
stupid 0:aaf22a04f350 170 iap.read_eeprom((char*)address, (char*)&temp_limit_lower, sizeof(temp_limit_lower));
stupid 0:aaf22a04f350 171 address += sizeof(temp_limit_lower);
stupid 0:aaf22a04f350 172 iap.read_eeprom((char*)address, (char*)&temp_limit_upper, sizeof(temp_limit_upper));
stupid 0:aaf22a04f350 173 address += sizeof(temp_limit_upper);
stupid 0:aaf22a04f350 174 iap.read_eeprom((char*)address, (char*)&nominal_duty, sizeof(nominal_duty));
stupid 0:aaf22a04f350 175 address += sizeof(nominal_duty);
stupid 0:aaf22a04f350 176 }
stupid 0:aaf22a04f350 177
stupid 0:aaf22a04f350 178 //write settings to persistent memory
stupid 0:aaf22a04f350 179 void write_settings(void){
stupid 0:aaf22a04f350 180 IAP iap;
stupid 0:aaf22a04f350 181 uint8_t address = 1; //BASE_ADDRESS;
stupid 0:aaf22a04f350 182 uint16_t filter_temp = 0;
stupid 0:aaf22a04f350 183
stupid 0:aaf22a04f350 184 filter_temp = (int)(filter*100);
stupid 0:aaf22a04f350 185
stupid 0:aaf22a04f350 186 iap.write_eeprom((char*)&filter_temp, (char*)address, sizeof(filter_temp));
stupid 0:aaf22a04f350 187 address += sizeof(filter_temp);
stupid 0:aaf22a04f350 188 iap.write_eeprom((char*)&initial_duty, (char*)address, sizeof(initial_duty));
stupid 0:aaf22a04f350 189 address += sizeof(initial_duty);
stupid 0:aaf22a04f350 190 iap.write_eeprom((char*)&setpoint, (char*)address, sizeof(setpoint));
stupid 0:aaf22a04f350 191 address += sizeof(setpoint);
stupid 0:aaf22a04f350 192 iap.write_eeprom((char*)&tolerance, (char*)address, sizeof(tolerance));
stupid 0:aaf22a04f350 193 address += sizeof(tolerance);
stupid 0:aaf22a04f350 194 iap.write_eeprom((char*)&duty_too_large, (char*)address, sizeof(duty_too_large));
stupid 0:aaf22a04f350 195 address += sizeof(duty_too_large);
stupid 0:aaf22a04f350 196 iap.write_eeprom((char*)&temp_limit_lower, (char*)address, sizeof(temp_limit_lower));
stupid 0:aaf22a04f350 197 address += sizeof(temp_limit_lower);
stupid 0:aaf22a04f350 198 iap.write_eeprom((char*)&temp_limit_upper, (char*)address, sizeof(temp_limit_upper));
stupid 0:aaf22a04f350 199 address += sizeof(temp_limit_upper);
stupid 0:aaf22a04f350 200 iap.write_eeprom((char*)&nominal_duty, (char*)address, sizeof(nominal_duty));
stupid 0:aaf22a04f350 201 address += sizeof(nominal_duty);
stupid 0:aaf22a04f350 202 }
stupid 0:aaf22a04f350 203
stupid 0:aaf22a04f350 204 //parse commands. commands take the form of a character followed by a number, delimited by "\r|\n|;"
stupid 0:aaf22a04f350 205 void getInput(void){
stupid 0:aaf22a04f350 206 static int i = 0;
stupid 0:aaf22a04f350 207 static char parameter = '_';
stupid 0:aaf22a04f350 208 static char buffer[MAX_COMMAND_LEN + 1];
stupid 0:aaf22a04f350 209 int value = 0;
stupid 0:aaf22a04f350 210 //char *endp = NULL;
stupid 0:aaf22a04f350 211
stupid 0:aaf22a04f350 212 if(!connected) return;
stupid 0:aaf22a04f350 213
stupid 0:aaf22a04f350 214 // listen for commands coming in
stupid 0:aaf22a04f350 215 #ifdef SERIAL
stupid 0:aaf22a04f350 216 while (pc.readable()){
stupid 0:aaf22a04f350 217 char ch = pc.getc();
stupid 0:aaf22a04f350 218 #else
stupid 0:aaf22a04f350 219 while (pc.available()){
stupid 0:aaf22a04f350 220 char ch = pc._getc();
stupid 0:aaf22a04f350 221 #endif
stupid 0:aaf22a04f350 222 if((ch == '\r' || ch == ';' || ch == '\n') && parameter != '_'){
stupid 0:aaf22a04f350 223 if(i > 1){
stupid 0:aaf22a04f350 224 buffer[i-1] = 0;
stupid 0:aaf22a04f350 225 value = atoi(buffer);
stupid 0:aaf22a04f350 226 }
stupid 0:aaf22a04f350 227 pc.printf("%c, %d", parameter, value);
stupid 0:aaf22a04f350 228 //Serial.println("not _");
stupid 0:aaf22a04f350 229 interpret(parameter, value);
stupid 0:aaf22a04f350 230 parameter = '_';
stupid 0:aaf22a04f350 231 buffer[0] = 0;
stupid 0:aaf22a04f350 232 i=0;
stupid 0:aaf22a04f350 233 break;
stupid 0:aaf22a04f350 234 }
stupid 0:aaf22a04f350 235 else{
stupid 0:aaf22a04f350 236 if(i==0) parameter = ch;
stupid 0:aaf22a04f350 237 else buffer[i-1] = ch;
stupid 0:aaf22a04f350 238 i++;
stupid 0:aaf22a04f350 239 }
stupid 0:aaf22a04f350 240
stupid 0:aaf22a04f350 241 if(ch == '_' || ch == '\r' || ch == ';' || ch == '\n'){
stupid 0:aaf22a04f350 242 parameter = '_';
stupid 0:aaf22a04f350 243 buffer[0] = 0;
stupid 0:aaf22a04f350 244 i=0;
stupid 0:aaf22a04f350 245 }
stupid 0:aaf22a04f350 246 }
stupid 0:aaf22a04f350 247 }
stupid 0:aaf22a04f350 248
stupid 0:aaf22a04f350 249 //print usage info
stupid 0:aaf22a04f350 250 void usage(void){
stupid 0:aaf22a04f350 251 if(!connected)return;
stupid 0:aaf22a04f350 252 pc.printf("\r\nCommands are a character followed by a number.\r\n");
stupid 0:aaf22a04f350 253 wait_ms(1);
stupid 0:aaf22a04f350 254 pc.printf("Available commands are:\r\n");
stupid 0:aaf22a04f350 255 wait_ms(1);
stupid 0:aaf22a04f350 256 pc.printf("'c': duty cap [1-100]\r\n");
stupid 0:aaf22a04f350 257 wait_ms(1);
stupid 0:aaf22a04f350 258 pc.printf("'d': set the initial duty used on startup [1-100]\r\n");
stupid 0:aaf22a04f350 259 wait_ms(1);
stupid 0:aaf22a04f350 260 pc.printf("'f': set the smoothing filter for the temperature sensor.");
stupid 0:aaf22a04f350 261 wait_ms(1);
stupid 0:aaf22a04f350 262 pc.printf(" smaller is more smoothing. [1-100]\r\n");
stupid 0:aaf22a04f350 263 wait_ms(1);
stupid 0:aaf22a04f350 264 pc.printf("'l': lower temperature limit. arbitrary units. [1-1000]\r\n");
stupid 0:aaf22a04f350 265 wait_ms(1);
stupid 0:aaf22a04f350 266 pc.printf("'r': reset all parameters to default values.\r\n");
stupid 0:aaf22a04f350 267 wait_ms(1);
stupid 0:aaf22a04f350 268 pc.printf("'n': set the nominal duty used on control cycle start [1-100]\r\n");
stupid 0:aaf22a04f350 269 wait_ms(1);
stupid 0:aaf22a04f350 270 pc.printf("'s': setpoint. same units as upper and lower temperature");
stupid 0:aaf22a04f350 271 wait_ms(1);
stupid 0:aaf22a04f350 272 pc.printf(" limit [1-1000]\r\n");
stupid 0:aaf22a04f350 273 wait_ms(1);
stupid 0:aaf22a04f350 274 pc.printf("'t': tolerance. no control action within this band. same ");
stupid 0:aaf22a04f350 275 wait_ms(1);
stupid 0:aaf22a04f350 276 pc.printf("units as upper and lower temperature limit [1-1000]\r\n");
stupid 0:aaf22a04f350 277 wait_ms(1);
stupid 0:aaf22a04f350 278 pc.printf("'u': upper temperature limit. arbitrary units. [1-1000]\r\n");
stupid 0:aaf22a04f350 279 wait_ms(1);
stupid 0:aaf22a04f350 280 pc.printf("'w': write the current control parameters to permanent memory\r\n");
stupid 0:aaf22a04f350 281 wait_ms(1);
stupid 0:aaf22a04f350 282 pc.printf("\r\n\r\n");
stupid 0:aaf22a04f350 283 wait_ms(1);
stupid 0:aaf22a04f350 284
stupid 0:aaf22a04f350 285 pc.printf("Values can be modified by entering a ");
stupid 0:aaf22a04f350 286 pc.printf("command followed by a number.");
stupid 0:aaf22a04f350 287 wait_ms(1);
stupid 0:aaf22a04f350 288 pc.printf(" For example, entering 'c50' <enter> would limit the duty");
stupid 0:aaf22a04f350 289 wait_ms(1);
stupid 0:aaf22a04f350 290 pc.printf(" to 50%\r\n\r\n");
stupid 0:aaf22a04f350 291 wait_ms(1);
stupid 0:aaf22a04f350 292
stupid 0:aaf22a04f350 293 pc.printf("Status of individual variables can be queried by entering ");
stupid 0:aaf22a04f350 294 wait_ms(1);
stupid 0:aaf22a04f350 295 pc.printf("that command name (no number afterwards), or typing any ");
stupid 0:aaf22a04f350 296 wait_ms(1);
stupid 0:aaf22a04f350 297 pc.printf("unrecognised command (which prints this message).\r\n\r\n");
stupid 0:aaf22a04f350 298 wait_ms(1);
stupid 0:aaf22a04f350 299 }
stupid 0:aaf22a04f350 300
stupid 0:aaf22a04f350 301 void print_active_settings(void){
stupid 0:aaf22a04f350 302 if(!connected)return;
stupid 0:aaf22a04f350 303 pc.printf("Duty capped at: %u%\r\n", duty_too_large);
stupid 0:aaf22a04f350 304 wait_ms(1);
stupid 0:aaf22a04f350 305 pc.printf("Initial duty is: %u\r\n", initial_duty);
stupid 0:aaf22a04f350 306 wait_ms(1);
stupid 0:aaf22a04f350 307 pc.printf("Nominal duty is: %u\r\n", nominal_duty);
stupid 0:aaf22a04f350 308 wait_ms(1);
stupid 0:aaf22a04f350 309 pc.printf("Temperature filter is: %d\r\n", (int)(filter * 100));
stupid 0:aaf22a04f350 310 wait_ms(1);
stupid 0:aaf22a04f350 311 pc.printf("Lower temperature limit is: %u\r\n", temp_limit_lower);
stupid 0:aaf22a04f350 312 wait_ms(1);
stupid 0:aaf22a04f350 313 pc.printf("Upper temperature limit is: %u\r\n", temp_limit_upper);
stupid 0:aaf22a04f350 314 wait_ms(1);
stupid 0:aaf22a04f350 315 pc.printf("Setpoint is: %u\r\n", setpoint);
stupid 0:aaf22a04f350 316 wait_ms(1);
stupid 0:aaf22a04f350 317 pc.printf("Tolerance is %u\r\n\r\n", tolerance);
stupid 0:aaf22a04f350 318 wait_ms(1);
stupid 2:35e620097381 319 //pc.printf("Spot treatment time is %d\r\n\r\n", TIP_FLASH_INTERVAL_S);
stupid 2:35e620097381 320 //wait_ms(1);
stupid 0:aaf22a04f350 321 }
stupid 0:aaf22a04f350 322
stupid 0:aaf22a04f350 323 //interpret a user command
stupid 0:aaf22a04f350 324 void interpret(char parameter, int value){
stupid 0:aaf22a04f350 325 switch(parameter){
stupid 0:aaf22a04f350 326 case 'c':
stupid 0:aaf22a04f350 327 if(value != 0) duty_too_large = value;
stupid 0:aaf22a04f350 328 pc.printf("Duty cap is %u\r\n", duty_too_large);
stupid 0:aaf22a04f350 329 break;
stupid 0:aaf22a04f350 330 case 'd':
stupid 0:aaf22a04f350 331 if(value != 0) initial_duty = value;
stupid 0:aaf22a04f350 332 pc.printf("Initial duty is %u\r\n", initial_duty);
stupid 0:aaf22a04f350 333 break;
stupid 0:aaf22a04f350 334 case 'f':
stupid 0:aaf22a04f350 335 if(value != 0) filter = ((float)value) / 100.0;
stupid 0:aaf22a04f350 336 pc.printf("Filter is %d\r\n", (int)(filter * 100));
stupid 0:aaf22a04f350 337 break;
stupid 0:aaf22a04f350 338 case 'r':
stupid 0:aaf22a04f350 339 filter = DEFAULT_FILTER;
stupid 0:aaf22a04f350 340 initial_duty = DEFAULT_INITIAL_DUTY;
stupid 0:aaf22a04f350 341 nominal_duty = DEFAULT_NOMINAL_DUTY;
stupid 0:aaf22a04f350 342 setpoint = DEFAULT_SETPOINT;
stupid 0:aaf22a04f350 343 tolerance = DEFAULT_TOLERANCE;
stupid 0:aaf22a04f350 344 duty_too_large = DEFAULT_DUTY_TOO_LARGE;
stupid 0:aaf22a04f350 345 temp_limit_lower = DEFAULT_TEMP_LIMIT_LOWER;
stupid 0:aaf22a04f350 346 temp_limit_upper = DEFAULT_TEMP_LIMIT_UPPER;
stupid 0:aaf22a04f350 347 write_settings();
stupid 0:aaf22a04f350 348 pc.printf("All parameters reset to default values:\r\n");
stupid 0:aaf22a04f350 349 print_active_settings();
stupid 0:aaf22a04f350 350 break;
stupid 0:aaf22a04f350 351 case 'l':
stupid 0:aaf22a04f350 352 if(value != 0) temp_limit_lower = value;
stupid 0:aaf22a04f350 353 pc.printf("Lower temperature limit is %u\r\n", temp_limit_lower);
stupid 0:aaf22a04f350 354 break;
stupid 0:aaf22a04f350 355 case 'n':
stupid 0:aaf22a04f350 356 if(value != 0) nominal_duty = value;
stupid 0:aaf22a04f350 357 pc.printf("Nominal duty is %u\r\n", nominal_duty);
stupid 0:aaf22a04f350 358 break;
stupid 0:aaf22a04f350 359 case 's':
stupid 0:aaf22a04f350 360 if(value != 0) setpoint = value;
stupid 0:aaf22a04f350 361 pc.printf("Setpoint is %u\r\n", setpoint);
stupid 0:aaf22a04f350 362 break;
stupid 0:aaf22a04f350 363 case 't':
stupid 0:aaf22a04f350 364 if(value != 0) tolerance = value;
stupid 0:aaf22a04f350 365 pc.printf("Tolerance is %u\r\n", tolerance);
stupid 0:aaf22a04f350 366 break;
stupid 0:aaf22a04f350 367 case 'u':
stupid 0:aaf22a04f350 368 if(value != 0) temp_limit_upper = value;
stupid 0:aaf22a04f350 369 pc.printf("Upper temperature limit is %u\r\n", temp_limit_upper);
stupid 0:aaf22a04f350 370 break;
stupid 0:aaf22a04f350 371 case 'w':
stupid 0:aaf22a04f350 372 write_settings();
stupid 0:aaf22a04f350 373 pc.printf("Wrote the current control parameters to memory.\r\n");
stupid 0:aaf22a04f350 374 break;
stupid 0:aaf22a04f350 375
stupid 0:aaf22a04f350 376
stupid 0:aaf22a04f350 377 default:
stupid 0:aaf22a04f350 378 usage();
stupid 0:aaf22a04f350 379 print_active_settings();
stupid 0:aaf22a04f350 380 break;
stupid 0:aaf22a04f350 381 }
stupid 0:aaf22a04f350 382 }
stupid 0:aaf22a04f350 383
stupid 0:aaf22a04f350 384 //put everything into a low power/off state. control loop will be unaffected by this command, so that will also need to be disabled before the heater will stay off
stupid 0:aaf22a04f350 385 void all_off(){
stupid 0:aaf22a04f350 386 heater_pin = 0;
stupid 0:aaf22a04f350 387 heater = OFF; //need to treat this as volatile
stupid 0:aaf22a04f350 388 fan = 0;
stupid 0:aaf22a04f350 389 empty_led.input(); //
stupid 0:aaf22a04f350 390 fuel_gage_1.input(); // = 1;
stupid 0:aaf22a04f350 391 fuel_gage_2.input(); // = 1;
stupid 0:aaf22a04f350 392 fuel_gage_3.input(); // = 1;
stupid 0:aaf22a04f350 393 fuel_gage_4.input(); // = 1;
stupid 0:aaf22a04f350 394 tip_light = 0;
stupid 0:aaf22a04f350 395 }
stupid 0:aaf22a04f350 396
stupid 0:aaf22a04f350 397 // run this to manually check the hardware works
stupid 0:aaf22a04f350 398 // probably best to disable the heater on the first try
stupid 0:aaf22a04f350 399 void functional_check(void){
stupid 1:ccb26dd9845a 400 all_off();
stupid 0:aaf22a04f350 401 if(connected)pc.printf("Tip light\r\n");
stupid 0:aaf22a04f350 402 tip_light = 1;
stupid 0:aaf22a04f350 403 wait_ms(1000);
stupid 0:aaf22a04f350 404 all_off();
stupid 0:aaf22a04f350 405 if(connected)pc.printf("Empty\r\n");
stupid 0:aaf22a04f350 406 empty_led.output();
stupid 0:aaf22a04f350 407 empty_led = 0;
stupid 0:aaf22a04f350 408 wait_ms(1000);
stupid 0:aaf22a04f350 409 all_off();
stupid 0:aaf22a04f350 410 if(connected)pc.printf("Fuel Gage 1\r\n");
stupid 0:aaf22a04f350 411 fuel_gage_1.output();
stupid 0:aaf22a04f350 412 fuel_gage_1 = 0;
stupid 0:aaf22a04f350 413 wait_ms(1000);
stupid 0:aaf22a04f350 414 all_off();
stupid 0:aaf22a04f350 415 if(connected)pc.printf("Fuel Gage 2\r\n");
stupid 0:aaf22a04f350 416 fuel_gage_2.output();
stupid 0:aaf22a04f350 417 fuel_gage_2 = 0;
stupid 0:aaf22a04f350 418 wait_ms(1000);
stupid 0:aaf22a04f350 419 all_off();
stupid 0:aaf22a04f350 420 if(connected)pc.printf("Fuel Gage 3\r\n");
stupid 0:aaf22a04f350 421 fuel_gage_3.output();
stupid 0:aaf22a04f350 422 fuel_gage_3 = 0;
stupid 0:aaf22a04f350 423 wait_ms(1000);
stupid 0:aaf22a04f350 424 all_off();
stupid 0:aaf22a04f350 425 if(connected)pc.printf("Fuel Gage 4\r\n");
stupid 0:aaf22a04f350 426 fuel_gage_4.output();
stupid 0:aaf22a04f350 427 fuel_gage_4 = 0;
stupid 0:aaf22a04f350 428 wait_ms(1000);
stupid 0:aaf22a04f350 429 all_off();
stupid 0:aaf22a04f350 430 if(connected)pc.printf("Fan\r\n");
stupid 0:aaf22a04f350 431 fan = 1;
stupid 0:aaf22a04f350 432 wait_ms(5000);
stupid 0:aaf22a04f350 433 if(connected)pc.printf("Heater\r\n");
stupid 0:aaf22a04f350 434 heater_pin = 1;
stupid 0:aaf22a04f350 435
stupid 0:aaf22a04f350 436 while(1){
stupid 0:aaf22a04f350 437 if(connected)pc.printf("Temp: %u\r\n", temp_sense.read_u16()>>6);
stupid 0:aaf22a04f350 438 wait_ms(50);
stupid 0:aaf22a04f350 439 tip_light = 1;
stupid 0:aaf22a04f350 440 wait_ms(50);
stupid 0:aaf22a04f350 441 tip_light = 0;
stupid 0:aaf22a04f350 442 }
stupid 0:aaf22a04f350 443 }
stupid 0:aaf22a04f350 444
stupid 0:aaf22a04f350 445 // INTERRUPT - called every 4ms, samples the ADC and filters the value with a low pass first order digital filter
stupid 0:aaf22a04f350 446 void get_temp(void){
stupid 0:aaf22a04f350 447 // not bothering with units, this means we need to keep the update constant at once every 4ms or we will need to set the filter again
stupid 0:aaf22a04f350 448 //temperature = filter * (temp_sense.read_u16()>>6) + (1 - filter) * temperature;
stupid 0:aaf22a04f350 449 // temperature is now in degrees C (value is at sensor, not at tips)
stupid 0:aaf22a04f350 450 temperature = filter * (51.282 * (temp_sense.read()*3.3 - 0.4)) + (1 - filter) * temperature;
stupid 0:aaf22a04f350 451 }
stupid 0:aaf22a04f350 452
stupid 0:aaf22a04f350 453 // INTERRUPT - called every millisecond to handle maintaining the on/off state of the triac
stupid 0:aaf22a04f350 454 void heater_control(void){
stupid 0:aaf22a04f350 455 static uint8_t count = 0;
stupid 0:aaf22a04f350 456
stupid 0:aaf22a04f350 457 // count up once per interrupt.
stupid 0:aaf22a04f350 458 // safety: check to make sure we haven't exceeded MAX_DUTY safety limit
stupid 0:aaf22a04f350 459 // after duty is reached for this control period, turn the heat off
stupid 0:aaf22a04f350 460 count++;
stupid 0:aaf22a04f350 461
stupid 0:aaf22a04f350 462 if(heater == ON && fan.read()){
stupid 0:aaf22a04f350 463 if(count > MAX_DUTY){
stupid 0:aaf22a04f350 464 count = 0;
stupid 0:aaf22a04f350 465 heater_pin = 1;
stupid 0:aaf22a04f350 466 }
stupid 0:aaf22a04f350 467 if(count > duty)heater_pin = 0;
stupid 0:aaf22a04f350 468 }
stupid 0:aaf22a04f350 469 else heater_pin = 0;
stupid 0:aaf22a04f350 470 }
stupid 0:aaf22a04f350 471
stupid 0:aaf22a04f350 472 // bail, something is wrong
stupid 0:aaf22a04f350 473 void abort(bool error){
stupid 0:aaf22a04f350 474 uint16_t period = 1000;
stupid 0:aaf22a04f350 475 if(error) period = 250;
stupid 0:aaf22a04f350 476 // turn everything off, leave the fan on for a few seconds and flash the red LED
stupid 0:aaf22a04f350 477 control_interrupt.detach();
stupid 0:aaf22a04f350 478 all_off();
stupid 0:aaf22a04f350 479 empty_led.input();
stupid 0:aaf22a04f350 480 fan = 1;
stupid 0:aaf22a04f350 481 wait_ms(3000);
stupid 0:aaf22a04f350 482 fan = 0;
stupid 0:aaf22a04f350 483 while(1){
stupid 0:aaf22a04f350 484 empty_led.output();
stupid 0:aaf22a04f350 485 empty_led = 0;
stupid 0:aaf22a04f350 486 heater_pin = 0;
stupid 0:aaf22a04f350 487 wait_ms(period);
stupid 0:aaf22a04f350 488 heater_pin = 0;
stupid 0:aaf22a04f350 489 empty_led.input();
stupid 0:aaf22a04f350 490 heater_pin = 0;
stupid 0:aaf22a04f350 491 wait_ms(period);
stupid 0:aaf22a04f350 492 }
stupid 0:aaf22a04f350 493 }
stupid 0:aaf22a04f350 494
stupid 0:aaf22a04f350 495 // INTERRUPT - monitor stuff that might indicate an error condition
stupid 0:aaf22a04f350 496 void check_limits(void){
stupid 0:aaf22a04f350 497 // need to move printing to the main loop
stupid 0:aaf22a04f350 498 if(duty >= duty_too_large){
stupid 0:aaf22a04f350 499 if(connected){
stupid 0:aaf22a04f350 500 pc.printf("Error!!! Duty cycle has become unreasonably ");
stupid 0:aaf22a04f350 501 pc.printf("large, Aborting.\r\n");
stupid 0:aaf22a04f350 502 }
stupid 0:aaf22a04f350 503 abort(true);
stupid 0:aaf22a04f350 504 }
stupid 0:aaf22a04f350 505
stupid 0:aaf22a04f350 506 if(get_temperature() > temp_limit_upper){
stupid 0:aaf22a04f350 507 if(connected)pc.printf("Error!!! Temperature is too high, Aborting.\r\n");
stupid 0:aaf22a04f350 508 abort(true);
stupid 0:aaf22a04f350 509 }
stupid 0:aaf22a04f350 510
stupid 0:aaf22a04f350 511 if((state == ACTIVE || state == INITIAL_RAMP) && (get_temperature() < temp_limit_lower)){
stupid 0:aaf22a04f350 512 if(connected){
stupid 0:aaf22a04f350 513 pc.printf("%f\r\n", get_temperature());
stupid 0:aaf22a04f350 514 pc.printf("Error!!! Abnormally low temperature detected. ");
stupid 0:aaf22a04f350 515 pc.printf("Please check the sensor, Aborting.\r\n");
stupid 0:aaf22a04f350 516 }
stupid 0:aaf22a04f350 517 abort(true);
stupid 0:aaf22a04f350 518 }
stupid 0:aaf22a04f350 519 }
stupid 0:aaf22a04f350 520
stupid 0:aaf22a04f350 521 // values pulled from the MCP9701T-E/LT datasheet
stupid 0:aaf22a04f350 522 // 19.5mV/deg-C, 400mV @ 0C
stupid 0:aaf22a04f350 523 float adc_to_temp(float adc_value){
stupid 0:aaf22a04f350 524 //return 0.195 * adc_value -
stupid 0:aaf22a04f350 525 return 0.196 * adc_value - 31.322;
stupid 0:aaf22a04f350 526 }
stupid 0:aaf22a04f350 527
stupid 0:aaf22a04f350 528 void init(void){
stupid 0:aaf22a04f350 529 #ifdef SERIAL
stupid 0:aaf22a04f350 530 pc.baud(115200);
stupid 0:aaf22a04f350 531 connected = true;
stupid 0:aaf22a04f350 532 #else
stupid 0:aaf22a04f350 533 pc.connect();
stupid 0:aaf22a04f350 534 connected = pc.vbusDetected();
stupid 0:aaf22a04f350 535 #endif
stupid 0:aaf22a04f350 536
stupid 0:aaf22a04f350 537 if(connected)pc.printf("hello\r\n");
stupid 0:aaf22a04f350 538
stupid 0:aaf22a04f350 539 tick_interrupt.attach(&tick, 0.001);
stupid 0:aaf22a04f350 540 control_interrupt.attach(&heater_control, 0.001);
stupid 0:aaf22a04f350 541 temperature_interrupt.attach(&get_temp, 0.004);
stupid 0:aaf22a04f350 542 if(!CALIBRATE)check_limits_interrupt.attach(&check_limits, 0.5);
stupid 0:aaf22a04f350 543
stupid 0:aaf22a04f350 544 read_settings();
stupid 0:aaf22a04f350 545 set_duty(initial_duty);
stupid 0:aaf22a04f350 546 all_off();
stupid 0:aaf22a04f350 547 }
stupid 0:aaf22a04f350 548
stupid 1:ccb26dd9845a 549 void check_on_off(void){
stupid 1:ccb26dd9845a 550 static uint32_t count = 0;
stupid 1:ccb26dd9845a 551
stupid 1:ccb26dd9845a 552 // debounce
stupid 1:ccb26dd9845a 553 if(on_off){
stupid 1:ccb26dd9845a 554 count++;
stupid 1:ccb26dd9845a 555 if(count > ON_OFF_DEBOUNCE){
stupid 1:ccb26dd9845a 556 all_off();
stupid 1:ccb26dd9845a 557 state = IDLE;
stupid 1:ccb26dd9845a 558 }
stupid 1:ccb26dd9845a 559 }
stupid 1:ccb26dd9845a 560 else count = 0;
stupid 1:ccb26dd9845a 561 }
stupid 1:ccb26dd9845a 562
stupid 1:ccb26dd9845a 563 void do_idle(bool first){
stupid 1:ccb26dd9845a 564 if(!on_off) state = WAIT_FOR_TIP;
stupid 1:ccb26dd9845a 565 }
stupid 1:ccb26dd9845a 566
stupid 0:aaf22a04f350 567 // tip neeeds to be present before we can start the cycle
stupid 1:ccb26dd9845a 568 // later we should also abort the cycle if the tip is removed
stupid 0:aaf22a04f350 569 void do_wait_for_tip(bool first){
stupid 0:aaf22a04f350 570 unsigned long time = get_time();
stupid 0:aaf22a04f350 571 unsigned long time_increment = time % 1800;
stupid 0:aaf22a04f350 572
stupid 0:aaf22a04f350 573 if(first){
stupid 0:aaf22a04f350 574 if(connected)pc.printf("Looking for tip\r\n");
stupid 0:aaf22a04f350 575 }
stupid 0:aaf22a04f350 576 if(!tip_sensor){ //tip present is low == present
stupid 0:aaf22a04f350 577 tip_light = 1;
stupid 0:aaf22a04f350 578 fuel_gage_1.output();
stupid 0:aaf22a04f350 579 fuel_gage_1 = 0;
stupid 0:aaf22a04f350 580 fuel_gage_2.output();
stupid 0:aaf22a04f350 581 fuel_gage_2 = 0;
stupid 0:aaf22a04f350 582 fuel_gage_3.output();
stupid 0:aaf22a04f350 583 fuel_gage_3 = 0;
stupid 0:aaf22a04f350 584 fuel_gage_4.output();
stupid 0:aaf22a04f350 585 fuel_gage_4 = 0;
stupid 0:aaf22a04f350 586 empty_led.input();
stupid 0:aaf22a04f350 587 state = INITIAL_RAMP;
stupid 0:aaf22a04f350 588 if(connected)pc.printf("Found the tip\r\n");
stupid 0:aaf22a04f350 589 return;
stupid 0:aaf22a04f350 590 }
stupid 0:aaf22a04f350 591
stupid 0:aaf22a04f350 592 if(time_increment < 300){
stupid 0:aaf22a04f350 593 fuel_gage_1.input(); // = 1;
stupid 0:aaf22a04f350 594 fuel_gage_2.input(); // = 1;
stupid 0:aaf22a04f350 595 fuel_gage_3.input(); // = 1;
stupid 0:aaf22a04f350 596 fuel_gage_4.input(); // = 1;
stupid 0:aaf22a04f350 597 }
stupid 0:aaf22a04f350 598 if(time_increment > 600){
stupid 0:aaf22a04f350 599 fuel_gage_1.output();
stupid 0:aaf22a04f350 600 fuel_gage_1 = 0;
stupid 0:aaf22a04f350 601 }
stupid 0:aaf22a04f350 602 if(time_increment > 900){
stupid 0:aaf22a04f350 603 fuel_gage_2.output();
stupid 0:aaf22a04f350 604 fuel_gage_2 = 0;
stupid 0:aaf22a04f350 605 }
stupid 0:aaf22a04f350 606 if(time_increment > 1200){
stupid 0:aaf22a04f350 607 fuel_gage_3.output();
stupid 0:aaf22a04f350 608 fuel_gage_3 = 0;
stupid 0:aaf22a04f350 609 }
stupid 0:aaf22a04f350 610 if(time_increment > 1500){
stupid 0:aaf22a04f350 611 fuel_gage_4.output();
stupid 0:aaf22a04f350 612 fuel_gage_4 = 0;
stupid 0:aaf22a04f350 613 }
stupid 0:aaf22a04f350 614 }
stupid 0:aaf22a04f350 615
stupid 0:aaf22a04f350 616 //This should quickly take us up from ambient to the setpoint.
stupid 0:aaf22a04f350 617 void do_initial_ramp(bool first){
stupid 0:aaf22a04f350 618 // set duty to initial_duty and wait to reach the setpoint to break out
stupid 0:aaf22a04f350 619 static uint32_t start_time = 0;
stupid 0:aaf22a04f350 620 static uint32_t last_print = get_time();
stupid 0:aaf22a04f350 621
stupid 0:aaf22a04f350 622 if(first){
stupid 1:ccb26dd9845a 623 print_active_settings();
stupid 0:aaf22a04f350 624 start_time = get_time();
stupid 0:aaf22a04f350 625 fan = 1;
stupid 0:aaf22a04f350 626 set_duty(initial_duty);
stupid 0:aaf22a04f350 627 heater = ON;
stupid 0:aaf22a04f350 628 if(connected)pc.printf("Initial ramp up. Duty will be held constant until setpoint is reached.\r\n");
stupid 0:aaf22a04f350 629 }
stupid 0:aaf22a04f350 630
stupid 0:aaf22a04f350 631 if(get_time() - start_time > 60000){
stupid 0:aaf22a04f350 632 if(connected)pc.printf("Took too long to reach setpoint, aborting.\r\n");
stupid 0:aaf22a04f350 633 abort(true);
stupid 0:aaf22a04f350 634 }
stupid 0:aaf22a04f350 635
stupid 0:aaf22a04f350 636 if(get_time() - last_print > 5000){
stupid 1:ccb26dd9845a 637 if(connected)pc.printf("Duty: %u, Temp: %.2f, Time: %.2fs\r\n", get_duty(), get_temperature(), (float)get_time()/1000);
stupid 0:aaf22a04f350 638 last_print = get_time();
stupid 0:aaf22a04f350 639 }
stupid 0:aaf22a04f350 640
stupid 0:aaf22a04f350 641 if(get_temperature() > setpoint - tolerance){
stupid 0:aaf22a04f350 642 //now we are roughly up to temperature
stupid 0:aaf22a04f350 643 set_duty(nominal_duty);
stupid 0:aaf22a04f350 644 state = ACTIVE;
stupid 0:aaf22a04f350 645 return;
stupid 0:aaf22a04f350 646 }
stupid 0:aaf22a04f350 647 }
stupid 0:aaf22a04f350 648
stupid 0:aaf22a04f350 649 void do_treatment_cycle(bool first){
stupid 0:aaf22a04f350 650 static uint32_t start_time = 0;
stupid 0:aaf22a04f350 651 static uint32_t control_timer = 0;
stupid 0:aaf22a04f350 652 uint8_t duty_copy;
stupid 0:aaf22a04f350 653 float temperature_copy;
stupid 0:aaf22a04f350 654
stupid 0:aaf22a04f350 655 if(first){
stupid 0:aaf22a04f350 656 start_time = get_time();
stupid 0:aaf22a04f350 657 control_timer = start_time;
stupid 0:aaf22a04f350 658 }
stupid 0:aaf22a04f350 659
stupid 0:aaf22a04f350 660 uint32_t current_time = get_time() - start_time;
stupid 0:aaf22a04f350 661
stupid 0:aaf22a04f350 662 // check if we're done
stupid 0:aaf22a04f350 663 if(current_time >= ON_TIME_S * 1000L){
stupid 0:aaf22a04f350 664 if(connected)pc.printf("Done!\r\n");
stupid 1:ccb26dd9845a 665 //abort(false);
stupid 1:ccb26dd9845a 666 set_duty(0);
stupid 1:ccb26dd9845a 667 fan = 0;
stupid 1:ccb26dd9845a 668 state = DONE;
stupid 0:aaf22a04f350 669 }
stupid 0:aaf22a04f350 670
stupid 0:aaf22a04f350 671 //if(!tip->in_place())abort(false);
stupid 0:aaf22a04f350 672
stupid 0:aaf22a04f350 673 if(current_time - control_timer > 5000){ // run the control loop every 5 seconds
stupid 0:aaf22a04f350 674 control_timer = current_time;
stupid 0:aaf22a04f350 675 duty_copy = get_duty();
stupid 0:aaf22a04f350 676 temperature_copy = get_temperature();
stupid 0:aaf22a04f350 677 if(temperature_copy > setpoint + tolerance) duty_copy--;
stupid 0:aaf22a04f350 678 if(temperature_copy < setpoint - tolerance) duty_copy++;
stupid 0:aaf22a04f350 679 set_duty(duty_copy);
stupid 0:aaf22a04f350 680
stupid 1:ccb26dd9845a 681 if(connected)pc.printf("Duty: %u, Temp: %.2f, Time: %.2fs\r\n", get_duty(), get_temperature(), ((float)get_time() - (float)start_time)/1000);
stupid 1:ccb26dd9845a 682 }
stupid 1:ccb26dd9845a 683 }
stupid 1:ccb26dd9845a 684
stupid 1:ccb26dd9845a 685 void do_done(bool first){
stupid 1:ccb26dd9845a 686 static uint32_t start_time = 0;
stupid 1:ccb26dd9845a 687
stupid 1:ccb26dd9845a 688 if(first){
stupid 1:ccb26dd9845a 689 start_time = get_time();
stupid 1:ccb26dd9845a 690 //control_interrupt.detach();
stupid 1:ccb26dd9845a 691 all_off();
stupid 1:ccb26dd9845a 692 if(connected)pc.printf("Done!\r\n");
stupid 1:ccb26dd9845a 693 }
stupid 1:ccb26dd9845a 694
stupid 1:ccb26dd9845a 695 heater_pin = 0;
stupid 1:ccb26dd9845a 696 uint32_t current_time = get_time() - start_time;
stupid 1:ccb26dd9845a 697
stupid 1:ccb26dd9845a 698 if(current_time % 2000 > 1000){
stupid 1:ccb26dd9845a 699 empty_led.input();
stupid 1:ccb26dd9845a 700 }
stupid 1:ccb26dd9845a 701 else{
stupid 1:ccb26dd9845a 702 empty_led.output();
stupid 1:ccb26dd9845a 703 empty_led = 0;
stupid 0:aaf22a04f350 704 }
stupid 0:aaf22a04f350 705 }
stupid 0:aaf22a04f350 706
stupid 0:aaf22a04f350 707 void print_state(void){
stupid 0:aaf22a04f350 708 if(!connected)return;
stupid 1:ccb26dd9845a 709 printf("State:\t");
stupid 0:aaf22a04f350 710 switch(state){
stupid 0:aaf22a04f350 711 case IDLE:
stupid 0:aaf22a04f350 712 printf("IDLE\r\n");
stupid 0:aaf22a04f350 713 break;
stupid 0:aaf22a04f350 714 case WAIT_FOR_TIP:
stupid 0:aaf22a04f350 715 printf("WAIT_FOR_TIP\r\n");
stupid 0:aaf22a04f350 716 break;
stupid 0:aaf22a04f350 717 case INITIAL_RAMP:
stupid 0:aaf22a04f350 718 printf("INITIAL_RAMP\r\n");
stupid 0:aaf22a04f350 719 break;
stupid 0:aaf22a04f350 720 case ACTIVE:
stupid 0:aaf22a04f350 721 printf("ACTIVE\r\n");
stupid 0:aaf22a04f350 722 break;
stupid 1:ccb26dd9845a 723 case DONE:
stupid 1:ccb26dd9845a 724 printf("DONE\r\n");
stupid 1:ccb26dd9845a 725 break;
stupid 0:aaf22a04f350 726 case ERROR:
stupid 0:aaf22a04f350 727 printf("ERROR\r\n");
stupid 0:aaf22a04f350 728 break;
stupid 0:aaf22a04f350 729 default: break;
stupid 0:aaf22a04f350 730 }
stupid 0:aaf22a04f350 731 }
stupid 0:aaf22a04f350 732
stupid 0:aaf22a04f350 733 int main(){
stupid 0:aaf22a04f350 734 static State last_state = IDLE;
stupid 0:aaf22a04f350 735 init();
stupid 1:ccb26dd9845a 736 if(FUNCTION_CHECK) functional_check();
stupid 0:aaf22a04f350 737 if(CALIBRATE){
stupid 0:aaf22a04f350 738 calibrate(true);
stupid 0:aaf22a04f350 739 while(1)calibrate(false);
stupid 0:aaf22a04f350 740 }
stupid 0:aaf22a04f350 741
stupid 0:aaf22a04f350 742 while(1){
stupid 1:ccb26dd9845a 743 getInput();
stupid 1:ccb26dd9845a 744
stupid 1:ccb26dd9845a 745 check_on_off();
stupid 0:aaf22a04f350 746
stupid 0:aaf22a04f350 747 bool state_change = false;
stupid 0:aaf22a04f350 748 if(state != last_state){
stupid 0:aaf22a04f350 749 state_change = true;
stupid 0:aaf22a04f350 750 last_state = state;
stupid 0:aaf22a04f350 751 print_state();
stupid 0:aaf22a04f350 752 }
stupid 0:aaf22a04f350 753
stupid 0:aaf22a04f350 754 switch(state){
stupid 0:aaf22a04f350 755 case IDLE:
stupid 1:ccb26dd9845a 756 do_idle(state_change);
stupid 0:aaf22a04f350 757 break;
stupid 0:aaf22a04f350 758 case WAIT_FOR_TIP:
stupid 0:aaf22a04f350 759 do_wait_for_tip(state_change);
stupid 0:aaf22a04f350 760 break;
stupid 0:aaf22a04f350 761 case INITIAL_RAMP:
stupid 0:aaf22a04f350 762 do_initial_ramp(state_change);
stupid 0:aaf22a04f350 763 spin_lights(state_change);
stupid 0:aaf22a04f350 764 break;
stupid 0:aaf22a04f350 765 case ACTIVE:
stupid 0:aaf22a04f350 766 do_treatment_cycle(state_change);
stupid 0:aaf22a04f350 767 spin_lights(false);
stupid 0:aaf22a04f350 768 break;
stupid 1:ccb26dd9845a 769 case DONE:
stupid 1:ccb26dd9845a 770 do_done(state_change);
stupid 1:ccb26dd9845a 771 break;
stupid 0:aaf22a04f350 772 case ERROR:
stupid 0:aaf22a04f350 773 abort(true);
stupid 0:aaf22a04f350 774 break;
stupid 0:aaf22a04f350 775 default: break;
stupid 0:aaf22a04f350 776 }
stupid 0:aaf22a04f350 777 }
stupid 0:aaf22a04f350 778 }
stupid 0:aaf22a04f350 779
stupid 0:aaf22a04f350 780 void spin_lights(bool first){
stupid 0:aaf22a04f350 781 static uint32_t start_time = 0;
stupid 0:aaf22a04f350 782
stupid 0:aaf22a04f350 783 if(first) start_time = get_time();
stupid 0:aaf22a04f350 784 uint32_t current_time = get_time() - start_time;
stupid 0:aaf22a04f350 785
stupid 1:ccb26dd9845a 786 // tip should be solid for TIP_FLASH_INTERVAL_S seconds, then flash for 3 seconds
stupid 1:ccb26dd9845a 787 uint32_t tip_time = current_time % (TIP_FLASH_INTERVAL_S * 1000 + 3000);
stupid 1:ccb26dd9845a 788 if(tip_time < (TIP_FLASH_INTERVAL_S * 1000)) tip_light = 1;
stupid 0:aaf22a04f350 789 else tip_light = (tip_time % 100 < 50)?1:0;
stupid 0:aaf22a04f350 790
stupid 1:ccb26dd9845a 791 // handle fuel gage LEDs
stupid 0:aaf22a04f350 792 // this should be more directly linked to the treatment stop condition
stupid 0:aaf22a04f350 793 uint32_t step = (ON_TIME_S - RED_LED_ON_TIME_S)/5;
stupid 0:aaf22a04f350 794 step *= 1000;
stupid 0:aaf22a04f350 795
stupid 0:aaf22a04f350 796 if(current_time > step) fuel_gage_4.input();
stupid 0:aaf22a04f350 797 else{
stupid 0:aaf22a04f350 798 fuel_gage_4.output();
stupid 0:aaf22a04f350 799 fuel_gage_4 = 0;
stupid 0:aaf22a04f350 800 }
stupid 0:aaf22a04f350 801 if(current_time > 2*step) fuel_gage_3.input();
stupid 0:aaf22a04f350 802 else{
stupid 0:aaf22a04f350 803 fuel_gage_3.output();
stupid 0:aaf22a04f350 804 fuel_gage_3 = 0;
stupid 0:aaf22a04f350 805 }
stupid 0:aaf22a04f350 806 if(current_time > 3*step) fuel_gage_2.input();
stupid 0:aaf22a04f350 807 else{
stupid 0:aaf22a04f350 808 fuel_gage_2.output();
stupid 0:aaf22a04f350 809 fuel_gage_2 = 0;
stupid 0:aaf22a04f350 810 }
stupid 0:aaf22a04f350 811 if(current_time > 4*step) fuel_gage_1.input();
stupid 0:aaf22a04f350 812 else{
stupid 0:aaf22a04f350 813 fuel_gage_1.output();
stupid 0:aaf22a04f350 814 fuel_gage_1 = 0;
stupid 0:aaf22a04f350 815 }
stupid 0:aaf22a04f350 816 if(current_time > 5*step){
stupid 0:aaf22a04f350 817 empty_led.output();
stupid 0:aaf22a04f350 818 empty_led = 0;
stupid 0:aaf22a04f350 819 }
stupid 0:aaf22a04f350 820 else empty_led.input();
stupid 0:aaf22a04f350 821 }
stupid 0:aaf22a04f350 822
stupid 0:aaf22a04f350 823 void calibrate(bool first){
stupid 0:aaf22a04f350 824 static uint32_t start_time = 0;
stupid 0:aaf22a04f350 825 static uint32_t control_timer = 0;
stupid 0:aaf22a04f350 826 uint8_t duty_copy;
stupid 0:aaf22a04f350 827
stupid 0:aaf22a04f350 828 if(first){
stupid 0:aaf22a04f350 829 start_time = get_time();
stupid 0:aaf22a04f350 830 control_timer = start_time;
stupid 0:aaf22a04f350 831 fan = 1;
stupid 0:aaf22a04f350 832 set_duty(5);
stupid 0:aaf22a04f350 833 heater = ON;
stupid 0:aaf22a04f350 834 }
stupid 0:aaf22a04f350 835
stupid 0:aaf22a04f350 836 uint32_t current_time = get_time() - start_time;
stupid 0:aaf22a04f350 837
stupid 0:aaf22a04f350 838 if(current_time - control_timer > 15000){ // increase the duty by 5% every 15 seconds
stupid 0:aaf22a04f350 839 if(connected)pc.printf("Duty: %u, Temp: %f, Time: %.2fs\r\n", get_duty(), get_temperature(), ((float)get_time() - (float)start_time)/1000);
stupid 0:aaf22a04f350 840 control_timer = current_time;
stupid 0:aaf22a04f350 841 duty_copy = get_duty();
stupid 0:aaf22a04f350 842 duty_copy += 5;
stupid 0:aaf22a04f350 843 // check if we're done
stupid 0:aaf22a04f350 844 if(duty > 75 && connected){
stupid 0:aaf22a04f350 845 set_duty(1);
stupid 0:aaf22a04f350 846 pc.printf("Done!\r\n");
stupid 0:aaf22a04f350 847 abort(false);
stupid 0:aaf22a04f350 848 }
stupid 0:aaf22a04f350 849 set_duty(duty_copy);
stupid 0:aaf22a04f350 850 }
stupid 0:aaf22a04f350 851 }
stupid 0:aaf22a04f350 852
stupid 0:aaf22a04f350 853 /*
stupid 0:aaf22a04f350 854 void calibrate(void){
stupid 0:aaf22a04f350 855 // this is really not necessary because all we care about is the temperature we need to hold the sensor at,
stupid 0:aaf22a04f350 856 // which we are assuming directly correlates to output air temp.
stupid 0:aaf22a04f350 857 // in reality it will probably be affected by ambient temperature,
stupid 0:aaf22a04f350 858 // humidity, air flow rate, elevation (air density), and other factors
stupid 0:aaf22a04f350 859 static uint16_t count = 0;
stupid 0:aaf22a04f350 860 static uint8_t duty_copy = 5; //inital duty
stupid 0:aaf22a04f350 861 float temperature_copy;
stupid 0:aaf22a04f350 862 static int tester_count = 0;
stupid 0:aaf22a04f350 863
stupid 0:aaf22a04f350 864 current_time = get_time();
stupid 0:aaf22a04f350 865 count++;
stupid 0:aaf22a04f350 866
stupid 0:aaf22a04f350 867 check_limits();
stupid 0:aaf22a04f350 868
stupid 0:aaf22a04f350 869 if(count > 200){ // run the control loop every second
stupid 0:aaf22a04f350 870 count = 0;
stupid 0:aaf22a04f350 871 tester_count++;
stupid 0:aaf22a04f350 872 if(tester_count % 30 == 0){ //30 seconds each duty cycle
stupid 0:aaf22a04f350 873 duty_copy += 5;
stupid 0:aaf22a04f350 874 if(duty > 85)abort(false);
stupid 0:aaf22a04f350 875 if(connected)pc.printf("Duty: %u\r\nTemps:\r\n", duty_copy);
stupid 0:aaf22a04f350 876 }
stupid 0:aaf22a04f350 877 __disable_irq();
stupid 0:aaf22a04f350 878 duty = duty_copy;
stupid 0:aaf22a04f350 879 temperature_copy = temperature;
stupid 0:aaf22a04f350 880 __enable_irq();
stupid 0:aaf22a04f350 881
stupid 1:ccb26dd9845a 882 if(connected && (tester_count % 30) > 24)pc.printf("\t%f\t%u\t%f\r\n", temperature_copy, temp_sense.read_u16(), temp_sense.read());
stupid 0:aaf22a04f350 883 }
stupid 0:aaf22a04f350 884 }*/