// SolderingStation2
//
// ATmega328-controlled Soldering Station for Hakko T12 Tips.
//
// This version of the code implements:
// - Temperature measurement of the tip
// - Direct or PID control of the heater
// - Temperature control via rotary encoder
// - Boost mode by short pressing rotary encoder switch
// - Setup menu by long pressing rotary encoder switch
// - Handle movement detection (by checking ball switch)
// - Iron unconnected detection (by idenfying invalid temperature readings)
// - Time driven sleep/power off mode if iron is unused (movement detection)
// - Measurement of input voltage, Vcc and ATmega's internal temperature
// - Information display on OLED
// - Buzzer
// - Calibrating and managing different soldering tips
// - Storing user settings into the EEPROM
// - Tip change detection
// - Can be used with either N or P channel mosfets
// - Screen flip support
// - Rotary encoder reverse support
//
// Power supply should be in the range of 16V/2A to 24V/3A and well
// stabilized.
//
// For calibration you need a soldering iron tips thermometer. For best results
// wait at least three minutes after switching on the soldering station before
// you start the calibration process.
//
// Controller: ATmega328p
// Core: Barebones ATmega (https://github.com/carlosefr/atmega)
// Clockspeed: 16 MHz external
//
// It is recommended not to use a bootloader!
//
// Thank you for the code contributions:
// - John Glavinos, https://youtu.be/4YDcWfOQmz4
// - createskyblue, https://github.com/createskyblue
// - TaaraLabs, https://github.com/TaaraLabs
// - muink, https://github.com/muink
//
// 2019 - 2022 by Stefan Wagner
// Project Files (EasyEDA): https://easyeda.com/wagiminator
// Project Files (Github): https://github.com/wagiminator
// License: http://creativecommons.org/licenses/by-sa/3.0/
// Libraries
/*
#include <ESP8266WiFi.h> //https://github.com/esp8266/Arduino
#include <DNSServer.h>
#include <ESP8266WebServer.h>
#include <WiFiManager.h> //https://github.com/tzapu/WiFiManager
//#include <ESP8266mDNS.h>
#include <WiFiUdp.h>
#include "ArduinoOTA.h" //https://github.com/esp8266/Arduino/tree/master/libraries/ArduinoOTA
*/
#include <U8glib.h> // https://github.com/olikraus/u8glib
#include <PID_v2.h> // https://github.com/wagiminator/ATmega-Soldering-Station/blob/master/software/libraries/Arduino-PID-Library.zip
// (old cpp version of https://github.com/mblythe86/C-PID-Library/tree/master/PID_v1)
#include <EEPROM.h> // for storing user settings into EEPROM
#include <avr/sleep.h> // for sleeping during ADC sampling
// Firmware version
#define VERSION "v1.9"
// Type of MOSFET
#define N_MOSFET // P_MOSFET or N_MOSFET
// Type of OLED Controller
#define SSD1306 // SSD1306 or SH1106
// Type of rotary encoder
#define ROTARY_TYPE 0 // 0: 2 increments/step; 1: 4 increments/step (default)
#define BUTTON_DELAY 10 // debouncing switches ms
// Pins
#define SENSOR_PIN A0 // tip temperature sense
#define VIN_PIN A1 // input voltage sense
#define BUZZER_PIN 5 // buzzer
#define BUTTON_PIN 6 // rotary encoder switch
#define BUTTON_P_PIN 8 // rotary encoder 1
#define BUTTON_N_PIN 7 // rotary encoder 2
#define CONTROL_PIN 9 // heater MOSFET PWM control
#define SWITCH_PIN 10 // handle vibration switch
// Default contrast control values (recommended brilliance: 180-200)
#define CTRS_DEFAULT 200 // default brilliance setpoint
// Default motion sensor sensitivity threshold values (smaller the value, more sensitive.)
#define MPU_THROLD 50 // default MPU sensitivity threshold
// Default temperature control values (recommended soldering temperature: 300-380°C)
#define TEMP_MIN 105 // min selectable temperature
#define TEMP_MAX 400 // max selectable temperature
#define TEMP_DEFAULT 320 // default start setpoint
#define TEMP_SLEEP 150 // temperature in sleep mode
#define TEMP_BOOST 50 // temperature increase in boost mode
#define TEMP_STEP 10 // rotary encoder temp change steps
// Default tip temperature calibration values
#define TEMP200 216 // temperature at ADC = 200
#define TEMP280 308 // temperature at ADC = 280
#define TEMP360 390 // temperature at ADC = 360
#define TEMPCHP 30 // chip temperature while calibration
#define TIPMAX 8 // max number of tips
#define TIPNAMELENGTH 6 // max length of tip names (including termination)
#define TIPNAME "BC1.5" // default tip name
// Default timer values (0 = disabled)
#define TIME2SLEEP 1 // time to enter sleep mode in minutes
#define TIME2OFF 2 // time to shut off heater in minutes
#define TIMEOFBOOST 40 // time to stay in boost mode in seconds
// Control values
#define TIME2SETTLE 950 // time in microseconds to allow OpAmp output to settle
#define SMOOTHIE 0.05 // OpAmp output smooth factor (1=no smoothing; 0.05 default)
#define PID_ENABLE false // enable PID control
#define BEEP_ENABLE false // enable/disable buzzer
#define BODYFLIP false // enable/disable screen flip
#define ECREVERSE false // enable/disable rotary encoder reverse
#define MAINSCREEN 1 // type of main screen (0: big numbers; 1: more infos)
// EEPROM identifier
#define EEPROM_IDENT 0xE76C // to identify if EEPROM was written by this program
// MOSFET control definitions
#if defined(P_MOSFET) // P-Channel MOSFET
#define HEATER_ON 255
#define HEATER_OFF 0
#define HEATER_PWM 255 - Output
#elif defined(N_MOSFET) // N-Channel MOSFET
#define HEATER_ON 0
#define HEATER_OFF 255
#define HEATER_PWM Output
#else
#error Wrong MOSFET type!
#endif
// Define the aggressive and conservative PID tuning parameters
double aggKp = 11, aggKi = 0.5, aggKd = 1;
double consKp = 11, consKi = 3, consKd = 5;
// Default values that can be changed by the user and stored in the EEPROM
uint16_t DefaultTemp = TEMP_DEFAULT;
uint16_t SleepTemp = TEMP_SLEEP;
uint8_t BoostTemp = TEMP_BOOST;
uint8_t time2sleep = TIME2SLEEP;
uint8_t time2off = TIME2OFF;
uint8_t timeOfBoost = TIMEOFBOOST;
uint8_t MainScrType = MAINSCREEN;
uint8_t ContrastSet = CTRS_DEFAULT;
uint8_t MpuThreshold = MPU_THROLD;
bool PIDenable = PID_ENABLE;
bool beepEnable = BEEP_ENABLE;
bool BodyFlip = BODYFLIP;
bool ECReverse = ECREVERSE;
// Default values for tips
uint16_t CalTemp[TIPMAX][4] = { TEMP200, TEMP280, TEMP360, TEMPCHP };
char TipName[TIPMAX][TIPNAMELENGTH] = { TIPNAME };
uint8_t CurrentTip = 0;
uint8_t NumberOfTips = 1;
// Menu items
//const char *SetupItems[] = { "Setup Menu", "Tip Settings", "Temp Settings", "Timer Settings", "Control Type", "Main Screen", "Buzzer", "Screen Flip", "EC Reverse", "Information", "Return" };
const char *SetupItems[] = { "Setup Menu", "Tip Settings", "Temp Settings", "Timer Options", "Control Type", "Buzzer", "Screen Pref.", "EC Reverse", "MPU Threshold", "Information", "OTA Update", "Return" };
const char *TipItems[] = { "Tip:", "Change Tip", "Calibrate Tip", "Rename Tip", "Delete Tip", "Add new Tip", "Return" };
const char *TempItems[] = { "Temp Settings", "Default Temp", "Sleep Temp", "Boost Temp", "Return" };
const char *TimerItems[] = { "Timer Settings", "Sleep Timer", "Off Timer", "Boost Timer", "Return" };
const char *ControlTypeItems[] = { "Control Type", "Direct", "PID" };
const char *ScrnPrefItems[] = { "Screen Options", "Set Contrast", "Screen Flip", "Main Screen", "Return"};
const char *MainScreenItems[] = { "Main Screen", "Big Numbers", "More Infos" };
//const char *StoreItems[] = { "Store Settings ?", "No", "Yes" };
const char *StoreItems[] = { "Save Settings?", "No", "Yes" };
const char *SureItems[] = { "Are you sure?", "No", "Yes" };
const char *BuzzerItems[] = { "Buzzer", "Disable", "Enable" };
const char *FlipItems[] = { "Screen Flip", "Disable", "Enable" };
const char *ECReverseItems[] = { "EC Reverse", "Disable", "Enable" };
const char *MpuThresholdItems[] = { "MPU Threshold", "mg" };
const char *OtaUpdateItems[] = { "OTA Update?", "No", "Yes" };
const char *DefaultTempItems[] = { "Default Temp", "\xB0""C" };
const char *SleepTempItems[] = { "Sleep Temp", "\xB0""C" };
const char *BoostTempItems[] = { "Boost Temp", "\xB0""C" };
const char *SleepTimerItems[] = { "Sleep Timer", "Minutes" };
const char *OffTimerItems[] = { "Off Timer", "Minutes" };
const char *BoostTimerItems[] = { "Boost Timer", "Seconds" };
const char *ContrastSetItems[] = { "Contrast Set", " " };
//const char *DeleteMessage[] = { "Warning", "You cannot", "delete your", "last tip!" };
const char *DeleteMessage[] = { "Warning", "Last tip!" };
//const char *MaxTipMessage[] = { "Warning", "You reached", "maximum number", "of tips!" };
const char *MaxTipMessage[] = { "Warning", "Maximum tips!" };
// Variables for pin change interrupt
//volatile uint8_t a0, b0;
volatile uint8_t c0, d0;
//volatile bool ab0;
volatile int count, countMin, countMax, countStep;
volatile bool handleMoved;
// Variables for temperature control
uint16_t SetTemp, ShowTemp, gap, Step;
double Input, Output, Setpoint, RawTemp, CurrentTemp, ChipTemp;
// Variables for voltage readings
uint16_t Vcc, Vin;
// State variables
bool inSleepMode = false;
bool inOffMode = false;
bool inBoostMode = false;
bool inCalibMode = false;
bool isWorky = true;
bool beepIfWorky = true;
bool TipIsPresent = true;
// Timing variables
uint32_t sleepmillis;
uint32_t boostmillis;
uint32_t switchmillis;
uint32_t buttonmillis;
uint8_t goneMinutes;
uint8_t goneSeconds;
uint8_t SensorCounter = 255;
// Specify variable pointers and initial PID tuning parameters
PID ctrl(&Input, &Output, &Setpoint, aggKp, aggKi, aggKd, REVERSE);
// Setup u8g object depending on OLED controller
#if defined(SSD1306)
U8GLIB_SSD1306_128X64 u8g(U8G_I2C_OPT_DEV_0 | U8G_I2C_OPT_NO_ACK | U8G_I2C_OPT_FAST);
#elif defined(SH1106)
U8GLIB_SH1106_128X64 u8g(U8G_I2C_OPT_FAST | U8G_I2C_OPT_NO_ACK);
#else
#error Wrong OLED controller type!
#endif
void setup() {
Serial.begin(115200);
// set the pin modes
pinMode(SENSOR_PIN, INPUT);
pinMode(VIN_PIN, INPUT);
pinMode(BUZZER_PIN, OUTPUT);
pinMode(CONTROL_PIN, OUTPUT);
pinMode(BUTTON_P_PIN, INPUT_PULLUP);
pinMode(BUTTON_N_PIN, INPUT_PULLUP);
pinMode(BUTTON_PIN, INPUT_PULLUP);
pinMode(SWITCH_PIN, INPUT_PULLUP);
analogWrite(CONTROL_PIN, HEATER_OFF); // this shuts off the heater
digitalWrite(BUZZER_PIN, LOW); // must be LOW when buzzer not in use
// setup ADC
ADCSRA |= bit(ADPS0) | bit(ADPS1) | bit(ADPS2); // set ADC prescaler to 128
ADCSRA |= bit(ADIE); // enable ADC interrupt
interrupts(); // enable global interrupts
// setup pin change interrupt for rotary encoder
//PCMSK0 = bit (PCINT0); // Configure pin change interrupt on Pin8
//PCICR = bit (PCIE0); // Enable pin change interrupt
//PCIFR = bit (PCIF0); // Clear interrupt flag
// prepare and start OLED
if (u8g.getMode() == U8G_MODE_R3G3B2) u8g.setColorIndex(255);
else if (u8g.getMode() == U8G_MODE_GRAY2BIT) u8g.setColorIndex(3);
else if (u8g.getMode() == U8G_MODE_BW) u8g.setColorIndex(1);
else if (u8g.getMode() == U8G_MODE_HICOLOR) u8g.setHiColorByRGB(255, 255, 255);
// get default values from EEPROM
getEEPROM();
// set screen flip
if (BodyFlip) u8g.setRot180();
else u8g.undoRotation();
// read supply voltages in mV
Vcc = getVCC();
Vin = getVIN();
// read and set current iron temperature
SetTemp = DefaultTemp;
RawTemp = denoiseAnalog(SENSOR_PIN);
ChipTemp = getChipTemp();
calculateTemp();
// turn on heater if iron temperature is well below setpoint
if ((CurrentTemp + 20) < DefaultTemp) analogWrite(CONTROL_PIN, HEATER_ON);
// set PID output range and start the PID
ctrl.SetOutputLimits(0, 255);
ctrl.SetMode(AUTOMATIC);
// set initial rotary encoder values
//a0 = PINB & 1; b0 = PIND >> 7 & 1; ab0 = (a0 == b0);
setRotary(TEMP_MIN, TEMP_MAX, TEMP_STEP, DefaultTemp);
// reset sleep timer
sleepmillis = millis();
// long beep for setup completion
beep();
beep();
}
void loop() {
ROTARYCheck(); // check rotary encoder (temp/boost setting, enter setup menu)
SLEEPCheck(); // check and activate/deactivate sleep modes
SENSORCheck(); // reads temperature and vibration switch of the iron
Thermostat(); // heater control
//WIFIOTACheck(); // check and activate/deactivate SW Update modes
MainScreen(); // updates the main page on the OLED
//ArduinoOTA.handle(); // check and activate/deactivate SW Update modes
}
// check rotary encoder; set temperature, toggle boost mode, enter setup menu accordingly
void ROTARYCheck() {
// set working temperature according to rotary encoder value
SetTemp = getRotary();
// check rotary encoder switch
uint8_t c = digitalRead(BUTTON_PIN);
if (!c && c0) {
beep();
switchmillis = millis();
while ((!digitalRead(BUTTON_PIN)) && ((millis() - switchmillis) < 500));
if ((millis() - switchmillis) >= 500) SetupScreen();
else {
inBoostMode = !inBoostMode;
if (inBoostMode) boostmillis = millis();
handleMoved = true;
}
}
c0 = c;
// check timer when in boost mode
if (inBoostMode && timeOfBoost) {
goneSeconds = (millis() - boostmillis) / 1000;
if (goneSeconds >= timeOfBoost) {
inBoostMode = false; // stop boost mode
beep(); // beep if boost mode is over
beepIfWorky = true; // beep again when working temperature is reached
}
}
}
// check and activate/deactivate sleep modes
void SLEEPCheck() {
if (handleMoved) { // if handle was moved
if (inSleepMode) { // in sleep or off mode?
if ((CurrentTemp + 20) < SetTemp) // if temp is well below setpoint
analogWrite(CONTROL_PIN, HEATER_ON); // then start the heater right now
beep(); // beep on wake-up
beepIfWorky = true; // beep again when working temperature is reached
}
handleMoved = false; // reset handleMoved flag
inSleepMode = false; // reset sleep flag
inOffMode = false; // reset off flag
sleepmillis = millis(); // reset sleep timer
}
// check time passed since the handle was moved
goneMinutes = (millis() - sleepmillis) / 60000;
if ((!inSleepMode) && (time2sleep > 0) && (goneMinutes >= time2sleep)) {
inSleepMode = true;
beep();
}
if ((!inOffMode) && (time2off > 0) && (goneMinutes >= time2off)) {
inOffMode = true;
beep();
}
}
// reads temperature, vibration switch and supply voltages
void SENSORCheck() {
analogWrite(CONTROL_PIN, HEATER_OFF); // shut off heater in order to measure temperature
delayMicroseconds(TIME2SETTLE); // wait for voltage to settle
double temp = denoiseAnalog(SENSOR_PIN); // read ADC value for temperature
//uint8_t d = digitalRead(SWITCH_PIN); // check handle vibration switch
//if (d != d0) {
handleMoved = true; // set flag if handle was moved
// d0 = d;
//}
if (!SensorCounter--) Vin = getVIN(); // get Vin every now and then
analogWrite(CONTROL_PIN, HEATER_PWM); // turn on again heater
RawTemp += (temp - RawTemp) * SMOOTHIE; // stabilize ADC temperature reading
calculateTemp(); // calculate real temperature value
// stabilize displayed temperature when around setpoint
if ((ShowTemp != Setpoint) || (abs(ShowTemp - CurrentTemp) > 5)) ShowTemp = CurrentTemp;
if (abs(ShowTemp - Setpoint) <= 1) ShowTemp = Setpoint;
// set state variable if temperature is in working range; beep if working temperature was just reached
gap = abs(SetTemp - CurrentTemp);
if (gap < 5) {
if (!isWorky && beepIfWorky) beep();
isWorky = true;
beepIfWorky = false;
} else isWorky = false;
// checks if tip is present or currently inserted
if (ShowTemp > 500) TipIsPresent = false; // tip removed ?
if (!TipIsPresent && (ShowTemp < 500)) { // new tip inserted ?
analogWrite(CONTROL_PIN, HEATER_OFF); // shut off heater
beep(); // beep for info
TipIsPresent = true; // tip is present now
ChangeTipScreen(); // show tip selection screen
updateEEPROM(); // update setting in EEPROM
handleMoved = true; // reset all timers
RawTemp = denoiseAnalog(SENSOR_PIN); // restart temp smooth algorithm
c0 = LOW; // switch must be released
setRotary(TEMP_MIN, TEMP_MAX, TEMP_STEP, SetTemp); // reset rotary encoder
}
}
// calculates real temperature value according to ADC reading and calibration values
void calculateTemp() {
//if (RawTemp < 200) CurrentTemp = map(RawTemp, 0, 200, 21, CalTemp[CurrentTip][0]);
//else if (RawTemp < 280) CurrentTemp = map(RawTemp, 200, 280, CalTemp[CurrentTip][0], CalTemp[CurrentTip][1]);
//else CurrentTemp = map(RawTemp, 280, 360, CalTemp[CurrentTip][1], CalTemp[CurrentTip][2]);
CurrentTemp = RawTemp * 4;
}
// controls the heater
void Thermostat() {
// define Setpoint acoording to current working mode
if (inOffMode) Setpoint = 0;
else if (inSleepMode) Setpoint = SleepTemp;
else if (inBoostMode) Setpoint = SetTemp + BoostTemp;
else Setpoint = SetTemp;
// control the heater (PID or direct)
gap = abs(Setpoint - CurrentTemp);
if (PIDenable) {
Input = CurrentTemp;
if (gap < 30) ctrl.SetTunings(consKp, consKi, consKd);
else ctrl.SetTunings(aggKp, aggKi, aggKd);
ctrl.Compute();
} else {
// turn on heater if current temperature is below setpoint
if ((CurrentTemp + 0.5) < Setpoint) Output = 0;
else Output = 255;
}
analogWrite(CONTROL_PIN, HEATER_PWM); // set heater PWM
}
// creates a short beep on the buzzer
void beep() {
if (beepEnable) {
for (uint8_t i = 0; i < 255; i++) {
digitalWrite(BUZZER_PIN, HIGH);
delayMicroseconds(125);
digitalWrite(BUZZER_PIN, LOW);
delayMicroseconds(125);
}
}
}
// sets start values for rotary encoder
void setRotary(int rmin, int rmax, int rstep, int rvalue) {
countMin = rmin << ROTARY_TYPE;
countMax = rmax << ROTARY_TYPE;
countStep = ECReverse ? -rstep : rstep;
count = rvalue << ROTARY_TYPE;
}
// reads current rotary encoder value
int getRotary() {
Button_loop();
return (count >> ROTARY_TYPE);
}
// reads user settings from EEPROM; if EEPROM values are invalid, write defaults
void getEEPROM() {
uint16_t identifier = (EEPROM.read(0) << 8) | EEPROM.read(1);
if (identifier == EEPROM_IDENT) {
DefaultTemp = (EEPROM.read(2) << 8) | EEPROM.read(3);
SleepTemp = (EEPROM.read(4) << 8) | EEPROM.read(5);
BoostTemp = EEPROM.read(6);
time2sleep = EEPROM.read(7);
time2off = EEPROM.read(8);
timeOfBoost = EEPROM.read(9);
MainScrType = EEPROM.read(10);
PIDenable = EEPROM.read(11);
beepEnable = EEPROM.read(12);
BodyFlip = EEPROM.read(13);
ECReverse = EEPROM.read(14);
CurrentTip = EEPROM.read(15);
NumberOfTips = EEPROM.read(16);
//ContrastSet = EEPROM.read(17);
//MpuSensitive = EEPROM.read(18);
uint8_t i, j;
uint16_t counter = 17;
for (i = 0; i < NumberOfTips; i++) {
for (j = 0; j < TIPNAMELENGTH; j++) {
TipName[i][j] = EEPROM.read(counter++);
}
for (j = 0; j < 4; j++) {
CalTemp[i][j] = EEPROM.read(counter++) << 8;
CalTemp[i][j] |= EEPROM.read(counter++);
}
}
} else {
EEPROM.update(0, EEPROM_IDENT >> 8);
EEPROM.update(1, EEPROM_IDENT & 0xFF);
updateEEPROM();
}
}
// writes user settings to EEPROM using updade function to minimize write cycles
void updateEEPROM() {
EEPROM.update(2, DefaultTemp >> 8);
EEPROM.update(3, DefaultTemp & 0xFF);
EEPROM.update(4, SleepTemp >> 8);
EEPROM.update(5, SleepTemp & 0xFF);
EEPROM.update(6, BoostTemp);
EEPROM.update(7, time2sleep);
EEPROM.update(8, time2off);
EEPROM.update(9, timeOfBoost);
EEPROM.update(10, MainScrType);
EEPROM.update(11, PIDenable);
EEPROM.update(12, beepEnable);
EEPROM.update(13, BodyFlip);
EEPROM.update(14, ECReverse);
EEPROM.update(15, CurrentTip);
EEPROM.update(16, NumberOfTips);
//EEPROM.update(17, ContrastSet);
//EEPROM.update(18, MpuSensitive);
uint8_t i, j;
uint16_t counter = 17;
for (i = 0; i < NumberOfTips; i++) {
for (j = 0; j < TIPNAMELENGTH; j++) EEPROM.update(counter++, TipName[i][j]);
for (j = 0; j < 4; j++) {
EEPROM.update(counter++, CalTemp[i][j] >> 8);
EEPROM.update(counter++, CalTemp[i][j] & 0xFF);
}
}
}
// check state and flip screen
void SetFlip() {
if (BodyFlip) u8g.setRot180();
else u8g.undoRotation();
}
// draws the main screen
void MainScreen() {
char str[10];
u8g.firstPage();
do {
u8g.drawRFrame(0, 0, 88, 48, 3);
// draw setpoint temperature
u8g.setFont(u8g_font_6x10r);
u8g.setFontPosTop();
/*
u8g.drawStr( 0, 0, "SET:");
u8g.setPrintPos(40, 0);
u8g.print(Setpoint, 0);
*/
strcpy(str, "SET:");
dtostrf(Setpoint, 3, 0, &str[strlen(str)]);
u8g.setPrintPos(0, 0);
u8g.print(str);
// draw status of heater
u8g.setPrintPos(58, 0);
if (ShowTemp > 500) u8g.print(F("ERROR"));
else if (inOffMode) u8g.print(F(" OFF"));
else if (inSleepMode) u8g.print(F("SLEEP"));
else if (inBoostMode) u8g.print(F("BOOST"));
else if (isWorky) u8g.print(F("WORKY"));
else if (Output < 180) u8g.print(F(" HEAT"));
else u8g.print(F(" HOLD"));
// rest depending on main screen type
char buff[4];
if (MainScrType) {
// draw current tip and input voltage
float fVin = (float)Vin / 1000; // convert mv in V
u8g.setPrintPos(0, 38);
u8g.print(TipName[CurrentTip]);
u8g.setPrintPos(58, 38);
u8g.print(fVin, 1);
u8g.print(F("V"));
// draw current temperature
u8g.setFont(u8g_font_gdr20n);
u8g.setFontPosTop();
u8g.setPrintPos(20, 13);
if (ShowTemp > 500) u8g.print(F("000"));
else {
sprintf(buff, "%03d", ShowTemp);
u8g.print(buff);
}
} else {
// draw current temperature in big figures
u8g.setFont(u8g_font_gdr30n);
u8g.setFontPosTop();
u8g.setPrintPos(9, 12);
if (ShowTemp > 500) u8g.print(F("000"));
else {
sprintf(buff, "%03d", ShowTemp);
u8g.print(buff);
}
}
} while (u8g.nextPage());
}
// setup screen
void SetupScreen() {
analogWrite(CONTROL_PIN, HEATER_OFF); // shut off heater
beep();
uint16_t SaveSetTemp = SetTemp;
uint8_t selection = 0;
bool repeat = true;
while (repeat) {
selection = MenuScreen(SetupItems, sizeof(SetupItems), selection);
switch (selection) {
case 0:
TipScreen();
repeat = false;
break;
case 1: TempScreen(); break;
case 2: TimerScreen(); break;
case 3: PIDenable = MenuScreen(ControlTypeItems, sizeof(ControlTypeItems), PIDenable); break;
//case 4: MainScrType = MenuScreen(MainScreenItems, sizeof(MainScreenItems), MainScrType); break;
case 4: beepEnable = MenuScreen(BuzzerItems, sizeof(BuzzerItems), beepEnable); break;
/*
case 6:
BodyFlip = MenuScreen(FlipItems, sizeof(FlipItems), BodyFlip);
SetFlip();
break;
*/
case 5: ScrnPrefScreen(); break;
case 6: ECReverse = MenuScreen(ECReverseItems, sizeof(ECReverseItems), ECReverse); break;
case 7: setRotary(0, 255, 10, MpuThreshold);
MpuThreshold = InputScreen(MpuThresholdItems); break; //MpuThreshold setting screen
case 8: InfoScreen(); break;
//case 8: OtaUpdate = MenuScreen(OtaUpdateItems, sizeof(OtaUpdateItems), OtaUpdate); break;
case 9: OtaUpdateScreen(); break;
default: repeat = false; break;
}
}
updateEEPROM();
handleMoved = true;
SetTemp = SaveSetTemp;
setRotary(TEMP_MIN, TEMP_MAX, TEMP_STEP, SetTemp);
}
// tip settings screen
void TipScreen() {
uint8_t selection = 0;
bool repeat = true;
while (repeat) {
selection = MenuScreen(TipItems, sizeof(TipItems), selection);
switch (selection) {
case 0: ChangeTipScreen(); break;
case 1: CalibrationScreen(); break;
case 2: InputNameScreen(); break;
case 3: DeleteTipScreen(); break;
case 4: AddTipScreen(); break;
default: repeat = false; break;
}
}
}
// temperature settings screen
void TempScreen() {
uint8_t selection = 0;
bool repeat = true;
while (repeat) {
selection = MenuScreen(TempItems, sizeof(TempItems), selection);
switch (selection) {
case 0:
setRotary(TEMP_MIN, TEMP_MAX, TEMP_STEP, DefaultTemp);
DefaultTemp = InputScreen(DefaultTempItems);
break;
case 1:
setRotary(20, 200, TEMP_STEP, SleepTemp);
SleepTemp = InputScreen(SleepTempItems);
break;
case 2:
setRotary(10, 100, TEMP_STEP, BoostTemp);
BoostTemp = InputScreen(BoostTempItems);
break;
default: repeat = false; break;
}
}
}
// timer settings screen
void TimerScreen() {
uint8_t selection = 0;
bool repeat = true;
while (repeat) {
selection = MenuScreen(TimerItems, sizeof(TimerItems), selection);
switch (selection) {
case 0:
setRotary(0, 30, 1, time2sleep);
time2sleep = InputScreen(SleepTimerItems);
break;
case 1:
setRotary(0, 60, 5, time2off);
time2off = InputScreen(OffTimerItems);
break;
case 2:
setRotary(0, 180, 10, timeOfBoost);
timeOfBoost = InputScreen(BoostTimerItems);
break;
default: repeat = false; break;
}
}
}
// screen prefered settings screen
void ScrnPrefScreen() {
uint8_t selection = 0;
bool repeat = true;
while (repeat) {
selection = MenuScreen(ScrnPrefItems, sizeof(ScrnPrefItems), selection);
switch (selection) {
case 0: setRotary(0, 255, 10, ContrastSet);
ContrastSet = InputScreen(ContrastSetItems);
u8g.setContrast(ContrastSet); break;
case 1: BodyFlip = MenuScreen(FlipItems, sizeof(FlipItems), BodyFlip);
if (BodyFlip) u8g.setRot180();
else u8g.undoRotation();
break;
case 2: MainScrType = MenuScreen(MainScreenItems, sizeof(MainScreenItems), MainScrType); break;
default: repeat = false; break;
}
}
}
// menu screen
uint8_t MenuScreen(const char *Items[], uint8_t numberOfItems, uint8_t selected) {
bool isTipScreen = (Items[0] == "Tip:");
uint8_t lastselected = selected;
int8_t arrow = 0;
if (selected) arrow = 1;
numberOfItems >>= 1;
setRotary(0, numberOfItems - 2, 1, selected);
bool lastbutton = (!digitalRead(BUTTON_PIN));
do {
selected = getRotary();
arrow = constrain(arrow + selected - lastselected, 0, 2);
//arrow = constrain(arrow + selected - lastselected, 0, 1); //显示2行菜单
lastselected = selected;
u8g.firstPage();
do {
u8g.drawRFrame(0, 0, 88, 48, 3);
u8g.setFont(u8g_font_6x10r);
u8g.setFontPosTop();
u8g.drawStr(0, 0, Items[0]);
if (isTipScreen) u8g.drawStr(54, 0, TipName[CurrentTip]);
u8g.drawStr(0, 12 * (arrow + 1), ">");
for (uint8_t i = 0; i < 3; i++) {
//for (uint8_t i=0; i<2; i++) { //显示2行菜单
uint8_t drawnumber = selected + i + 1 - arrow;
if (drawnumber < numberOfItems)
u8g.drawStr(8, 12 * (i + 1), Items[selected + i + 1 - arrow]);
}
} while (u8g.nextPage());
if (lastbutton && digitalRead(BUTTON_PIN)) {
delay(10);
lastbutton = false;
}
} while (digitalRead(BUTTON_PIN) || lastbutton);
beep();
return selected;
}
// Contrast setting screen
void ContrastScreen() {
setRotary(0, 255, 10, ContrastSet);
ContrastSet = InputScreen(ContrastSetItems);
u8g.setContrast(ContrastSet);
}
void MessageScreen(const char *Items[], uint8_t numberOfItems) {
bool lastbutton = (!digitalRead(BUTTON_PIN));
u8g.firstPage();
do {
u8g.drawRFrame(0, 0, 88, 48, 3);
u8g.setFont(u8g_font_6x10r);
u8g.setFontPosTop();
for (uint8_t i = 0; i < numberOfItems; i++) u8g.drawStr(0, i * 12, Items[i]);
} while (u8g.nextPage());
do {
if (lastbutton && digitalRead(BUTTON_PIN)) {
delay(10);
lastbutton = false;
}
} while (digitalRead(BUTTON_PIN) || lastbutton);
beep();
}
// input value screen
uint16_t InputScreen(const char *Items[]) {
bool isContrastScreen = (Items[0] == "Contrast Set");
bool isMPUScreen = (Items[0] == "MPU Threshold");
uint16_t value;
bool lastbutton = (!digitalRead(BUTTON_PIN));
do {
value = getRotary();
u8g.firstPage();
do {
u8g.drawRFrame(0, 0, 88, 48, 3);
u8g.setFont(u8g_font_6x10r);
u8g.setFontPosTop();
u8g.drawStr(0, 0, Items[0]);
if (isContrastScreen || isMPUScreen) {
u8g.drawFrame(4, 20, 80, 8);
u8g.drawBox(5, 21, map(value, 0, 255, 0, 78), 6);
}
//if (isMPUScreen) {
// u8g.drawBox(5, 21, map(value, 0, 255, 0, 78), 6);
//}
u8g.setPrintPos(0, 36);
u8g.print(">");
u8g.setPrintPos(8, 36);
if (value == 0 && !isContrastScreen) u8g.print(F("Deactivated"));
else {
u8g.print(value);
u8g.print(" ");
u8g.print(Items[1]);
}
} while (u8g.nextPage());
if (lastbutton && digitalRead(BUTTON_PIN)) {
delay(10);
lastbutton = false;
}
} while (digitalRead(BUTTON_PIN) || lastbutton);
beep();
return value;
}
// information display screen
void InfoScreen() {
bool lastbutton = (!digitalRead(BUTTON_PIN));
do {
Vcc = getVCC(); // read input voltage
float fVcc = (float)Vcc / 1000; // convert mV in V
Vin = getVIN(); // read supply voltage
float fVin = (float)Vin / 1000; // convert mv in V
float fTmp = getChipTemp(); // read cold junction temperature
u8g.firstPage();
do {
u8g.drawRFrame(0, 0, 88, 48, 3);
u8g.setFont(u8g_font_6x10r);
u8g.setFontPosTop();
u8g.setPrintPos(0, 0);
u8g.print(F("Firmware: "));
u8g.print(VERSION);
u8g.setPrintPos(0, 12);
u8g.print(F("Tmp: "));
u8g.print(fTmp, 1);
u8g.print(F(" C"));
u8g.setPrintPos(0, 24);
u8g.print(F("Vin: "));
u8g.print(fVin, 1);
u8g.print(F(" V"));
u8g.setPrintPos(0, 36);
u8g.print(F("Vcc: "));
u8g.print(fVcc, 1);
u8g.print(F(" V"));
} while (u8g.nextPage());
if (lastbutton && digitalRead(BUTTON_PIN)) {
delay(10);
lastbutton = false;
}
} while (digitalRead(BUTTON_PIN) || lastbutton);
beep();
}
// change tip screen
void ChangeTipScreen() {
uint8_t selected = CurrentTip;
uint8_t lastselected = selected;
int8_t arrow = 0;
if (selected) arrow = 1;
setRotary(0, NumberOfTips - 1, 1, selected);
bool lastbutton = (!digitalRead(BUTTON_PIN));
do {
selected = getRotary();
arrow = constrain(arrow + selected - lastselected, 0, 2);
lastselected = selected;
u8g.firstPage();
do {
u8g.drawRFrame(0, 0, 88, 48, 3);
u8g.setFont(u8g_font_6x10r);
u8g.setFontPosTop();
u8g.drawStr(0, 0, F("Select Tip"));
u8g.drawStr(0, 12 * (arrow + 1), ">");
for (uint8_t i = 0; i < 3; i++) {
uint8_t drawnumber = selected + i - arrow;
if (drawnumber < NumberOfTips)
u8g.drawStr(8, 12 * (i + 1), TipName[selected + i - arrow]);
}
} while (u8g.nextPage());
if (lastbutton && digitalRead(BUTTON_PIN)) {
delay(10);
lastbutton = false;
}
} while (digitalRead(BUTTON_PIN) || lastbutton);
beep();
CurrentTip = selected;
}
// temperature calibration screen
void CalibrationScreen() {
uint16_t CalTempNew[4];
for (uint8_t CalStep = 0; CalStep < 3; CalStep++) {
SetTemp = CalTemp[CurrentTip][CalStep];
setRotary(100, 500, 1, SetTemp);
beepIfWorky = true;
bool lastbutton = (!digitalRead(BUTTON_PIN));
do {
SENSORCheck(); // reads temperature and vibration switch of the iron
Thermostat(); // heater control
u8g.firstPage();
do {
u8g.drawRFrame(0, 0, 88, 48, 3);
u8g.setFont(u8g_font_6x10r);
u8g.setFontPosTop();
u8g.drawStr(0, 0, F("Calibration"));
u8g.setPrintPos(0, 12);
u8g.print(F("Step: "));
u8g.print(CalStep + 1);
u8g.print(" of 3");
if (isWorky) {
u8g.setPrintPos(0, 24);
u8g.print(F("Set measured"));
u8g.setPrintPos(0, 36);
u8g.print(F("temp: "));
u8g.print(getRotary());
} else {
u8g.setPrintPos(0, 24);
u8g.print(F("ADC: "));
u8g.print(uint16_t(RawTemp));
u8g.setPrintPos(0, 36);
u8g.print(F("Please wait..."));
}
} while (u8g.nextPage());
if (lastbutton && digitalRead(BUTTON_PIN)) {
delay(10);
lastbutton = false;
}
} while (digitalRead(BUTTON_PIN) || lastbutton);
CalTempNew[CalStep] = getRotary();
beep();
delay(10);
}
analogWrite(CONTROL_PIN, HEATER_OFF); // shut off heater
delayMicroseconds(TIME2SETTLE); // wait for voltage to settle
CalTempNew[3] = getChipTemp(); // read chip temperature
if ((CalTempNew[0] + 10 < CalTempNew[1]) && (CalTempNew[1] + 10 < CalTempNew[2])) {
if (MenuScreen(StoreItems, sizeof(StoreItems), 0)) {
for (uint8_t i = 0; i < 4; i++) CalTemp[CurrentTip][i] = CalTempNew[i];
}
}
}
// input tip name screen
void InputNameScreen() {
uint8_t value;
for (uint8_t digit = 0; digit < (TIPNAMELENGTH - 1); digit++) {
bool lastbutton = (!digitalRead(BUTTON_PIN));
setRotary(31, 96, 1, 65);
do {
value = getRotary();
if (value == 31) {
value = 95;
setRotary(31, 96, 1, 95);
}
if (value == 96) {
value = 32;
setRotary(31, 96, 1, 32);
}
u8g.firstPage();
do {
u8g.drawRFrame(0, 0, 88, 48, 3);
u8g.setFont(u8g_font_6x10r);
u8g.setFontPosTop();
u8g.drawStr(0, 0, F("Enter Tip Name"));
u8g.setPrintPos(6 * digit, 36);
u8g.print(char(94));
u8g.setPrintPos(0, 36);
for (uint8_t i = 0; i < digit; i++) u8g.print(TipName[CurrentTip][i]);
u8g.setPrintPos(6 * digit, 36);
u8g.print(char(value));
} while (u8g.nextPage());
if (lastbutton && digitalRead(BUTTON_PIN)) {
delay(10);
lastbutton = false;
}
} while (digitalRead(BUTTON_PIN) || lastbutton);
TipName[CurrentTip][digit] = value;
beep();
delay(10);
}
TipName[CurrentTip][TIPNAMELENGTH - 1] = 0;
return;
}
// delete tip screen
void DeleteTipScreen() {
if (NumberOfTips == 1) {
MessageScreen(DeleteMessage, sizeof(DeleteMessage));
} else if (MenuScreen(SureItems, sizeof(SureItems), 0)) {
if (CurrentTip == (NumberOfTips - 1)) {
CurrentTip--;
} else {
for (uint8_t i = CurrentTip; i < (NumberOfTips - 1); i++) {
for (uint8_t j = 0; j < TIPNAMELENGTH; j++) TipName[i][j] = TipName[i + 1][j];
for (uint8_t j = 0; j < 4; j++) CalTemp[i][j] = CalTemp[i + 1][j];
}
}
NumberOfTips--;
}
}
// add new tip screen
void AddTipScreen() {
if (NumberOfTips < TIPMAX) {
CurrentTip = NumberOfTips++;
InputNameScreen();
CalTemp[CurrentTip][0] = TEMP200;
CalTemp[CurrentTip][1] = TEMP280;
CalTemp[CurrentTip][2] = TEMP360;
CalTemp[CurrentTip][3] = TEMPCHP;
} else MessageScreen(MaxTipMessage, sizeof(MaxTipMessage));
}
// OtaUpdate screen
void OtaUpdateScreen() {
bool lastbutton = (!digitalRead(BUTTON_PIN));
if (MenuScreen(OtaUpdateItems, sizeof(OtaUpdateItems), 0)) {
do {
/*
Serial.begin(115200);
Serial.println("Booting");
//WiFiManager
//Local intialization. Once its business is done, there is no need to keep it around
WiFiManager wifiManager;
//reset saved settings
//wifiManager.resetSettings();
//set custom ip for portal
//wifiManager.setAPConfig(IPAddress(10,0,1,1), IPAddress(10,0,1,1), IPAddress(255,255,255,0));
//fetches ssid and pass from eeprom and tries to connect
//if it does not connect it starts an access point with the specified name
//here "AutoConnectAP"
//and goes into a blocking loop awaiting configuration
//if you like you can create AP with password
//wifiManager.autoConnect("APNAME", "password");
//or use this for auto generated name ESP + ChipID
wifiManager.autoConnect();
//if you get here you have connected to the WiFi
Serial.println("connected...yeey :)");
// Port defaults to 8266
// ArduinoOTA.setPort(8266);
// Hostname defaults to esp8266-[ChipID]
// ArduinoOTA.setHostname("myesp8266");
// No authentication by default
// ArduinoOTA.setPassword("admin");
// Password can be set with it's md5 value as well
// MD5(admin) = 21232f297a57a5a743894a0e4a801fc3
// ArduinoOTA.setPasswordHash("21232f297a57a5a743894a0e4a801fc3");
ArduinoOTA.onStart([]() {
String type;
if (ArduinoOTA.getCommand() == U_FLASH)
type = "sketch";
else // U_SPIFFS
type = "filesystem";
// NOTE: if updating SPIFFS this would be the place to unmount SPIFFS using SPIFFS.end()
Serial.println("Start updating " + type);
});
ArduinoOTA.onEnd([]() {
Serial.println("\nEnd");
});
ArduinoOTA.onProgress([](unsigned int progress, unsigned int total) {
Serial.printf("Progress: %u%%\r", (progress / (total / 100)));
});
ArduinoOTA.onError([](ota_error_t error) {
Serial.printf("Error[%u]: ", error);
if (error == OTA_AUTH_ERROR) Serial.println("Auth Failed");
else if (error == OTA_BEGIN_ERROR) Serial.println("Begin Failed");
else if (error == OTA_CONNECT_ERROR) Serial.println("Connect Failed");
else if (error == OTA_RECEIVE_ERROR) Serial.println("Receive Failed");
else if (error == OTA_END_ERROR) Serial.println("End Failed");
});
ArduinoOTA.begin();
Serial.println("Ready OTA");
Serial.print("IP address: ");
Serial.println(WiFi.localIP());
*/
u8g.firstPage();
do {
u8g.drawRFrame(0, 0, 88, 48, 3);
u8g.setFont(u8g_font_6x10r);
u8g.setFontPosTop();
u8g.drawStr(0, 0, F("Startting"));
u8g.drawStr(0, 12, F("SW Update!"));
} while (u8g.nextPage());
if (lastbutton && digitalRead(BUTTON_PIN)) {
delay(10);
lastbutton = false;
}
} while (digitalRead(BUTTON_PIN) || lastbutton);
}
}
// average several ADC readings in sleep mode to denoise
/*
uint16_t denoiseAnalog (byte port) {
uint16_t result = 0;
ADCSRA |= bit (ADEN) | bit (ADIF); // enable ADC, turn off any pending interrupt
if (port >= A0) port -= A0; // set port and
ADMUX = (0x0F & port) | bit(REFS0); // reference to AVcc
set_sleep_mode (SLEEP_MODE_ADC); // sleep during sample for noise reduction
for (uint8_t i = 0; i < 32; i++) { // get 32 readings
sleep_mode(); // go to sleep while taking ADC sample
while (bitRead(ADCSRA, ADSC)); // make sure sampling is completed
result += ADC; // add them up
}
bitClear (ADCSRA, ADEN); // disable ADC
return (result >> 5); // devide by 32 and return value
}
*/
uint16_t denoiseAnalog(byte port) {
uint16_t result;
for (uint8_t i = 0; i < 32; i++) { // get 32 readings 得到32个读数
uint16_t value;
if (analogRead(SENSOR_PIN) < 1300) {
//value = analogRead(SENSOR_PIN) * 1390 / 4095 * 0.4;
value = analogRead(SENSOR_PIN) * 1390 / 1023 * 0.4;
} else if (1300 <= analogRead(SENSOR_PIN) && analogRead(SENSOR_PIN) < 2300) {
//value = analogRead(SENSOR_PIN) * 1390 / 4095 * 0.357;
value = analogRead(SENSOR_PIN) * 1390 / 1023 * 0.357;
} else
//value = analogRead(SENSOR_PIN) * 1390 / 4095 * 0.34;
value = analogRead(SENSOR_PIN) * 1390 / 1023 * 0.34;
result += value; // add them up 把它们加起来
}
printf("raw_val: %d", analogRead(SENSOR_PIN));
printf("TEPM: %d", result / 32);
return (result >> 5); // devide by 32 and return value 除以32并返回值
}
// get internal temperature by reading ADC channel 8 against 1.1V reference
double getChipTemp() {
uint16_t result = 0;
ADCSRA |= bit(ADEN) | bit(ADIF); // enable ADC, turn off any pending interrupt
ADMUX = bit(REFS1) | bit(REFS0) | bit(MUX3); // set reference and mux
delay(20); // wait for voltages to settle
set_sleep_mode(SLEEP_MODE_ADC); // sleep during sample for noise reduction
for (uint8_t i = 0; i < 32; i++) { // get 32 readings
sleep_mode(); // go to sleep while taking ADC sample
while (bitRead(ADCSRA, ADSC)); // make sure sampling is completed
result += ADC; // add them up
}
bitClear(ADCSRA, ADEN); // disable ADC
result >>= 2; // devide by 4
return ((result - 2594) / 9.76); // calculate internal temperature in degrees C
}
// get input voltage in mV by reading 1.1V reference against AVcc
uint16_t getVCC() {
uint16_t result = 0;
ADCSRA |= bit(ADEN) | bit(ADIF); // enable ADC, turn off any pending interrupt
// set Vcc measurement against 1.1V reference
ADMUX = bit(REFS0) | bit(MUX3) | bit(MUX2) | bit(MUX1);
delay(1); // wait for voltages to settle
set_sleep_mode(SLEEP_MODE_ADC); // sleep during sample for noise reduction
for (uint8_t i = 0; i < 16; i++) { // get 16 readings
sleep_mode(); // go to sleep while taking ADC sample
while (bitRead(ADCSRA, ADSC)); // make sure sampling is completed
result += ADC; // add them up
}
bitClear(ADCSRA, ADEN); // disable ADC
result >>= 4; // devide by 16
return (1125300L / result); // 1125300 = 1.1 * 1023 * 1000
}
// get supply voltage in mV
uint16_t getVIN() {
long result;
result = denoiseAnalog(VIN_PIN); // read supply voltage via voltage divider
return (result * Vcc / 179.474); // 179.474 = 1023 * R13 / (R12 + R13)
}
// ADC interrupt service routine
EMPTY_INTERRUPT (ADC_vect); // nothing to be done here
// Pin change interrupt service routine for rotary encoder
/*
ISR (PCINT0_vect) {
uint8_t a = PINB & 1;
uint8_t b = PIND >> 7 & 1;
if (a != a0) { // A changed
a0 = a;
if (b != b0) { // B changed
b0 = b;
count = constrain(count + ((a == b) ? countStep : -countStep), countMin, countMax);
//Serial.println("count 1 ");
//Serial.println(count);
if (ROTARY_TYPE && ((a == b) != ab0)) {
count = constrain(count + ((a == b) ? countStep : -countStep), countMin, countMax);;
//Serial.println("Count 2 ");
//Serial.println(count);
}
ab0 = (a == b);
handleMoved = true;
}
}
}
*/
/*
void Button_loop() {
if (!digitalRead(BUTTON_N_PIN) && a0 == 1) {
delay(BUTTON_DELAY);
if (!digitalRead(BUTTON_N_PIN)) {
count = constrain(count - countStep, countMin, countMax);
a0 = 0;
}
} else if (digitalRead(BUTTON_N_PIN)) {
a0 = 1;
}
if (!digitalRead(BUTTON_P_PIN) && b0 == 1) {
delay(BUTTON_DELAY);
if (!digitalRead(BUTTON_P_PIN)) {
count = constrain(count + countStep, countMin, countMax);
b0 = 0;
}
} else if (digitalRead(BUTTON_P_PIN)) {
b0 = 1;
}
}
*/
//Button functions (add keys, subtract keys)
void Button_loop() {
if (digitalRead(BUTTON_P_PIN) != digitalRead(BUTTON_N_PIN)) {
delay(BUTTON_DELAY);
if (digitalRead(BUTTON_P_PIN) != digitalRead(BUTTON_N_PIN)) {
buttonmillis = millis();
if (digitalRead(BUTTON_P_PIN) == LOW) {
count = constrain(count + countStep, countMin, countMax);
while (digitalRead(BUTTON_P_PIN) == LOW) {
if (millis() - buttonmillis >= 500) {
count = constrain(count + 20, countMin, countMax);
break;
}
}
} else {
count = constrain(count - countStep, countMin, countMax);
while (digitalRead(BUTTON_N_PIN) == LOW) {
if (millis() - buttonmillis >= 500) {
count = constrain(count - 20, countMin, countMax);
break;
}
}
}
}
}
}