HAPI- Tech / Mbed 2 deprecated PreHeater

Origin firmware.

Dependencies:   PID QEI SB1602E mbed-rtos mbed

Fork of PreHeater by Kazu Zamasu

main.cpp@3:9af1bd67c5f8, 2015-06-14 (annotated)

Committer:
kazu_zamasu
Date:
Sun Jun 14 02:44:14 2015 +0000
Revision:
3:9af1bd67c5f8
Parent:
2:387240c58110
Child:
4:143b93e499a3
Rev0

Who changed what in which revision?

UserRevisionLine numberNew contents of line
kazu_zamasu 0:b1d44d6f9adf 1 #include "mbed.h"
kazu_zamasu 0:b1d44d6f9adf 2 #include "PID.h"
kazu_zamasu 0:b1d44d6f9adf 3 #include "QEI.h"
kazu_zamasu 0:b1d44d6f9adf 4 #include "rtos.h"
kazu_zamasu 0:b1d44d6f9adf 5 #include "math.h"
kazu_zamasu 2:387240c58110 6 #include "SB1602E.h"
kazu_zamasu 0:b1d44d6f9adf 7
kazu_zamasu 3:9af1bd67c5f8 8 /* PID constant initialize Kc, Ti, Td, interval */
kazu_zamasu 1:f974481c37b6 9 #define P 1.0 //propotional band
kazu_zamasu 1:f974481c37b6 10 #define I 0.2 //Integral
kazu_zamasu 1:f974481c37b6 11 #define D 0.1 //Devide
kazu_zamasu 1:f974481c37b6 12 #define RATE 0.1 //update time sec
kazu_zamasu 0:b1d44d6f9adf 13 PID TIC(P, I, D, RATE);
kazu_zamasu 0:b1d44d6f9adf 14
kazu_zamasu 1:f974481c37b6 15 //GPIO initilaize
kazu_zamasu 0:b1d44d6f9adf 16 AnalogIn THAI(dp4);
kazu_zamasu 0:b1d44d6f9adf 17 PwmOut out(dp1);
kazu_zamasu 0:b1d44d6f9adf 18 DigitalOut led1(dp14),led2(dp28);
kazu_zamasu 3:9af1bd67c5f8 19 DigitalIn Run(dp17,PullDown);
kazu_zamasu 1:f974481c37b6 20
kazu_zamasu 3:9af1bd67c5f8 21 /*Power on first setpoint temperature */
kazu_zamasu 3:9af1bd67c5f8 22 #define InitialSP 50.0 // PID initial setpoint
kazu_zamasu 3:9af1bd67c5f8 23 float temp_sv_input = InitialSP;
kazu_zamasu 3:9af1bd67c5f8 24
kazu_zamasu 2:387240c58110 25 double temp_pv,temp_cal;
kazu_zamasu 2:387240c58110 26 char *init_massage = "Welcome!";
kazu_zamasu 2:387240c58110 27
kazu_zamasu 3:9af1bd67c5f8 28
kazu_zamasu 3:9af1bd67c5f8 29 /*Rotary encode pin, pinmode and sppecification instance */
kazu_zamasu 3:9af1bd67c5f8 30 #define ROTATE_PER_REVOLUTIONS 24 //QEI 1 rotate by count
kazu_zamasu 1:f974481c37b6 31 QEI wheel(dp11, PullUp, dp13, PullUp,NC, ROTATE_PER_REVOLUTIONS, QEI::X2_ENCODING);
kazu_zamasu 3:9af1bd67c5f8 32
kazu_zamasu 3:9af1bd67c5f8 33 /*LCD I2C pin initialize */
kazu_zamasu 2:387240c58110 34 SB1602E lcd(dp5, dp27, init_massage); // SDA, SCL
kazu_zamasu 1:f974481c37b6 35
kazu_zamasu 2:387240c58110 36
kazu_zamasu 3:9af1bd67c5f8 37 void TempCal_thread(void const *args)
kazu_zamasu 3:9af1bd67c5f8 38 {
kazu_zamasu 0:b1d44d6f9adf 39 while (true) {
kazu_zamasu 3:9af1bd67c5f8 40 /*input for change to 0 to 100% range by 30C to 120C */
kazu_zamasu 3:9af1bd67c5f8 41 #define RangeSPL 30.0 //calcurate celcius range
kazu_zamasu 3:9af1bd67c5f8 42 #define RangeSPH 120.0 //same above
kazu_zamasu 3:9af1bd67c5f8 43 /*Temperature setpoint low high range */
kazu_zamasu 3:9af1bd67c5f8 44 temp_sv_input = wheel.getPulses() * 0.5 + RangeSPL;
kazu_zamasu 3:9af1bd67c5f8 45 if (temp_sv_input <= RangeSPL) {
kazu_zamasu 3:9af1bd67c5f8 46 temp_sv_input = RangeSPL;
kazu_zamasu 3:9af1bd67c5f8 47 } else if (temp_sv_input >= RangeSPH) {
kazu_zamasu 3:9af1bd67c5f8 48 temp_sv_input = RangeSPH;
kazu_zamasu 3:9af1bd67c5f8 49 }
kazu_zamasu 3:9af1bd67c5f8 50 temp_cal = THAI.read();
kazu_zamasu 3:9af1bd67c5f8 51
kazu_zamasu 3:9af1bd67c5f8 52
kazu_zamasu 3:9af1bd67c5f8 53 /*six order polynomial calculation value
kazu_zamasu 3:9af1bd67c5f8 54 Thermister pull up resiter 560R
kazu_zamasu 3:9af1bd67c5f8 55 Thermister B value 3380K
kazu_zamasu 3:9af1bd67c5f8 56 Thermister Resistance 10K ohm at 25C
kazu_zamasu 3:9af1bd67c5f8 57 */
kazu_zamasu 3:9af1bd67c5f8 58 temp_pv =-0.7964*pow(temp_cal,6.0) - 2.5431*pow(temp_cal,5.0) +63.605*pow(temp_cal,4.0) - 274.1*pow(temp_cal,3.0) + 522.57*pow(temp_cal,2.0) - 539.26*temp_cal + 405.76;
kazu_zamasu 1:f974481c37b6 59 Thread::wait(500);
kazu_zamasu 0:b1d44d6f9adf 60
kazu_zamasu 1:f974481c37b6 61
kazu_zamasu 3:9af1bd67c5f8 62 /*LCD Display section */
kazu_zamasu 3:9af1bd67c5f8 63 lcd.printf(0, "Temp SP %.1f\n", temp_sv_input);
kazu_zamasu 3:9af1bd67c5f8 64 lcd.printf(1, "Temp PV %.1f\n", temp_pv);
kazu_zamasu 3:9af1bd67c5f8 65 }
kazu_zamasu 3:9af1bd67c5f8 66 }
kazu_zamasu 3:9af1bd67c5f8 67
kazu_zamasu 3:9af1bd67c5f8 68
kazu_zamasu 3:9af1bd67c5f8 69
kazu_zamasu 3:9af1bd67c5f8 70 int main()
kazu_zamasu 3:9af1bd67c5f8 71 {
kazu_zamasu 3:9af1bd67c5f8 72 /* call Tmeperature calculate section */
kazu_zamasu 3:9af1bd67c5f8 73 Thread thread(TempCal_thread);
kazu_zamasu 3:9af1bd67c5f8 74 //LCD contrast set from 00 to 3f 64resolution defult set is 32step
kazu_zamasu 3:9af1bd67c5f8 75 #define LCDCont 0x32 //LCD contrast set from 00 to 3f 64resolution defult set is 32step
kazu_zamasu 3:9af1bd67c5f8 76 lcd.contrast(LCDCont);
kazu_zamasu 3:9af1bd67c5f8 77
kazu_zamasu 3:9af1bd67c5f8 78
kazu_zamasu 3:9af1bd67c5f8 79 while (1) {
kazu_zamasu 3:9af1bd67c5f8 80 /*Analog input from 30.0C to 120.0C by 0% to 100% */
kazu_zamasu 3:9af1bd67c5f8 81 #define SV_LL 0.0 //PID setpoint % value for lo limit
kazu_zamasu 3:9af1bd67c5f8 82 #define SV_HL 100.0 //PID setpoint % value for high limit
kazu_zamasu 3:9af1bd67c5f8 83 /* TIC PID setpoit limit set */
kazu_zamasu 3:9af1bd67c5f8 84 TIC.setInputLimits(SV_LL, SV_HL);
kazu_zamasu 3:9af1bd67c5f8 85
kazu_zamasu 3:9af1bd67c5f8 86 /* Output from 0.0 to 1.0*/
kazu_zamasu 3:9af1bd67c5f8 87 #define OV_LL 0.0 //PID calcurate output value 0.0 = 0%
kazu_zamasu 3:9af1bd67c5f8 88 #define OV_HL 1.0 //PID calcurate output value 1.0 = 100%
kazu_zamasu 3:9af1bd67c5f8 89 /* TIC PID control output limit set */
kazu_zamasu 3:9af1bd67c5f8 90 TIC.setOutputLimits(OV_LL, OV_HL);
kazu_zamasu 3:9af1bd67c5f8 91
kazu_zamasu 3:9af1bd67c5f8 92 /* TIC PID control output bias */
kazu_zamasu 3:9af1bd67c5f8 93 #define Bias 0.2 //control output bias
kazu_zamasu 3:9af1bd67c5f8 94 TIC.setBias(Bias);
kazu_zamasu 3:9af1bd67c5f8 95 /* TIC PID control mode set 0=Stop 1=Auto*/
kazu_zamasu 3:9af1bd67c5f8 96 TIC.setMode(Run);
kazu_zamasu 3:9af1bd67c5f8 97 /* TIC PID setpoint temperature read */
kazu_zamasu 3:9af1bd67c5f8 98 TIC.setSetPoint(temp_sv_input);
kazu_zamasu 3:9af1bd67c5f8 99
kazu_zamasu 3:9af1bd67c5f8 100 /* TIC PID output control */
kazu_zamasu 3:9af1bd67c5f8 101 if (Run == 0) {
kazu_zamasu 3:9af1bd67c5f8 102 out = OV_LL;
kazu_zamasu 3:9af1bd67c5f8 103 } else if (Run == 1) {
kazu_zamasu 3:9af1bd67c5f8 104 /* TIC PID read process value */
kazu_zamasu 3:9af1bd67c5f8 105 TIC.setProcessValue(temp_cal);
kazu_zamasu 3:9af1bd67c5f8 106 //PID calculate output.
kazu_zamasu 3:9af1bd67c5f8 107 out = TIC.compute();
kazu_zamasu 3:9af1bd67c5f8 108 }
kazu_zamasu 3:9af1bd67c5f8 109 //Wait for another loop calculation.
kazu_zamasu 3:9af1bd67c5f8 110 Thread::wait(RATE);
kazu_zamasu 3:9af1bd67c5f8 111 }
kazu_zamasu 3:9af1bd67c5f8 112 }