| Line 18... |
Line 18... |
| 18 |
#define TL1 PIN_B3 // tlacitko S1 |
18 |
#define TL1 PIN_B3 // tlacitko S1 |
| 19 |
#define TL2 PIN_B2 // tlacitko S2 |
19 |
#define TL2 PIN_B2 // tlacitko S2 |
| 20 |
#define TL3 PIN_B1 // tlacitko S3 |
20 |
#define TL3 PIN_B1 // tlacitko S3 |
| 21 |
#define TL4 PIN_B0 // tlacitko S4 |
21 |
#define TL4 PIN_B0 // tlacitko S4 |
| 22 |
|
22 |
|
| 23 |
#define POWER_T3 PIN_A3 // ovladani optotriaku T3 |
23 |
#define POWER_T3 PIN_C4 // ovladani optotriaku T3 |
| 24 |
#define POWER_T4 PIN_A5 // ovladani optotriaku T4 |
24 |
#define POWER_T4 PIN_C5 // ovladani optotriaku T4 |
| 25 |
#define POWER_T5 PIN_A4 // ovladani optotriaku T5 |
25 |
#define POWER_T5 PIN_C6 // ovladani optotriaku T5 |
| 26 |
|
26 |
|
| 27 |
#define ADC_PIN PIN_A0 //info, nelze menit - pin pouzit jako input analog |
27 |
#define ADC_PIN PIN_A0 //info, nelze menit - pin pouzit jako input analog |
| 28 |
#define ADC_PIN_NC PIN_A1 //info, nelze menit - pin pouzit jako input analog |
28 |
#define ADC_PIN_NC PIN_A1 //info, nelze menit - pin pouzit jako input analog |
| 29 |
#define REF_PIN PIN_A3 //info, nelze menit - pin pouzit jako input reference 2.5V |
29 |
#define REF_PIN PIN_A3 //info, nelze menit - pin pouzit jako input reference 2.5V |
| 30 |
|
30 |
|
| Line 62... |
Line 62... |
| 62 |
setup_comparator(NC_NC_NC_NC); |
62 |
setup_comparator(NC_NC_NC_NC); |
| 63 |
setup_vref(FALSE); |
63 |
setup_vref(FALSE); |
| 64 |
|
64 |
|
| 65 |
enable_interrupts(GLOBAL); |
65 |
enable_interrupts(GLOBAL); |
| 66 |
enable_interrupts(INT_TIMER2); |
66 |
enable_interrupts(INT_TIMER2); |
| - |
|
67 |
enable_interrupts(INT_TIMER1); |
| 67 |
|
68 |
|
| 68 |
setup_adc_ports(AN0_AN1_VSS_VREF); //A0 vstup cidla, A1 nepozit, A3 - ref. 2.5V |
69 |
setup_adc_ports(AN0_AN1_VSS_VREF); //A0 vstup cidla, A1 nepozit, A3 - ref. 2.5V |
| 69 |
setup_adc(ADC_CLOCK_DIV_8); |
70 |
setup_adc(ADC_CLOCK_DIV_8); |
| 70 |
SET_ADC_CHANNEL(0); //AN0, PIN_A0 |
71 |
SET_ADC_CHANNEL(0); //AN0, PIN_A0 |
| 71 |
} |
72 |
} |
| 72 |
|
73 |
|
| - |
|
74 |
void heat_failure() // exception in case of heating fail |
| - |
|
75 |
{ |
| - |
|
76 |
lcd_gotoxy(1,2); |
| - |
|
77 |
printf(lcd_putc,"HEATING FAILURE!"); |
| - |
|
78 |
|
| - |
|
79 |
while(true); |
| - |
|
80 |
|
| - |
|
81 |
} |
| - |
|
82 |
|
| 73 |
unsigned int16 adc(void) |
83 |
unsigned int16 adc(void) |
| 74 |
{ |
84 |
{ |
| 75 |
unsigned int16 analog; |
85 |
unsigned int16 analog; |
| 76 |
unsigned int8 a; |
86 |
unsigned int8 a; |
| 77 |
|
87 |
|
| Line 89... |
Line 99... |
| 89 |
return (0.674201*adc() - 294.35); |
99 |
return (0.674201*adc() - 294.35); |
| 90 |
} |
100 |
} |
| 91 |
|
101 |
|
| 92 |
void top_heating() |
102 |
void top_heating() |
| 93 |
{ |
103 |
{ |
| 94 |
if (period <= top_heat_power){ |
104 |
if (period < top_heat_power){ |
| 95 |
output_low(POWER_T4); |
105 |
output_low(POWER_T4); |
| 96 |
output_low(POWER_T5); |
106 |
output_low(POWER_T5); |
| 97 |
} |
107 |
} |
| 98 |
else{ |
108 |
else{ |
| 99 |
output_high(POWER_T4); |
109 |
output_high(POWER_T4); |
| Line 102... |
Line 112... |
| 102 |
} |
112 |
} |
| 103 |
|
113 |
|
| 104 |
void bottom_heating() |
114 |
void bottom_heating() |
| 105 |
{ |
115 |
{ |
| 106 |
|
116 |
|
| 107 |
if (period <= 2*bottom_heat_power){ |
117 |
if (period < 2*bottom_heat_power){ |
| 108 |
output_low(POWER_T3); |
118 |
output_low(POWER_T3); |
| 109 |
} |
119 |
} |
| 110 |
else{ |
120 |
else{ |
| 111 |
output_high(POWER_T3); |
121 |
output_high(POWER_T3); |
| 112 |
} |
122 |
} |
| Line 114... |
Line 124... |
| 114 |
} |
124 |
} |
| 115 |
|
125 |
|
| 116 |
#int_TIMER1 |
126 |
#int_TIMER1 |
| 117 |
void heating_control() //rizeni topnych teles pri preteceni casovace |
127 |
void heating_control() //rizeni topnych teles pri preteceni casovace |
| 118 |
{ |
128 |
{ |
| - |
|
129 |
top_heating(); |
| - |
|
130 |
bottom_heating(); |
| 119 |
|
131 |
|
| 120 |
top_heating(); |
- |
|
| 121 |
bottom_heating(); |
- |
|
| 122 |
|
- |
|
| 123 |
if (period <= 200) period++; |
132 |
if (period <= 200) period++; |
| 124 |
else period=0; |
133 |
else period=0; |
| 125 |
} |
134 |
} |
| 126 |
|
135 |
|
| 127 |
|
- |
|
| 128 |
#int_TIMER2 |
136 |
#int_TIMER2 |
| 129 |
void Rtc(void) //40ms |
137 |
void Rtc(void) //40ms |
| 130 |
{ |
138 |
{ |
| 131 |
static unsigned int8 ms40=0; |
139 |
static unsigned int8 ms40=0; |
| 132 |
struct time* time; |
140 |
struct time* time; |
| Line 148... |
Line 156... |
| 148 |
|
156 |
|
| 149 |
void slope_control(float ramp, unsigned int balance) // P proporcionalni rizeni narustu teploty predpoklada periodicke volani 1x/s |
157 |
void slope_control(float ramp, unsigned int balance) // P proporcionalni rizeni narustu teploty predpoklada periodicke volani 1x/s |
| 150 |
{ |
158 |
{ |
| 151 |
float slope_deviation; |
159 |
float slope_deviation; |
| 152 |
|
160 |
|
| 153 |
slope_deviation = (teplota() - temp_last) - ramp; // vypocet strmosti a odchylky od pozadovane strmosti |
161 |
slope_deviation = (teplota() - temp_last) - ramp; // vypocet strmosti a odchylky od pozadovane strmosti |
| 154 |
|
162 |
|
| 155 |
if(slope_deviation < 0) |
163 |
if(slope_deviation < 0) |
| 156 |
{ |
164 |
{ |
| 157 |
top_heat_power= slope_deviation*(-10) + balance; |
165 |
top_heat_power= 80 + balance; |
| 158 |
bottom_heat_power= slope_deviation*(-10); |
166 |
bottom_heat_power= 90; |
| 159 |
} |
167 |
} |
| 160 |
else{ |
168 |
else{ |
| 161 |
top_heat_power=0; |
169 |
top_heat_power=0; |
| 162 |
bottom_heat_power=0; |
170 |
bottom_heat_power=0; |
| 163 |
} |
171 |
} |
| 164 |
|
- |
|
| 165 |
temp_last = teplota(); |
172 |
temp_last = teplota(); |
| 166 |
} |
173 |
} |
| 167 |
|
174 |
|
| 168 |
void level_control(float level) // P proporcionalni rizeni teploty |
175 |
void level_control(float level) // P proporcionalni rizeni teploty |
| 169 |
{ |
176 |
{ |
| - |
|
177 |
if (teplota() > level) |
| - |
|
178 |
{ |
| - |
|
179 |
top_heat_power=0; |
| - |
|
180 |
bottom_heat_power=0; |
| 170 |
|
181 |
} |
| 171 |
teplota(); |
182 |
else |
| - |
|
183 |
{ |
| - |
|
184 |
top_heat_power=70; |
| - |
|
185 |
bottom_heat_power=80; |
| 172 |
|
186 |
} |
| 173 |
} |
187 |
} |
| 174 |
|
188 |
|
| 175 |
|
189 |
|
| 176 |
void nullcas(struct time* time) |
190 |
void nullcas(struct time* time) |
| 177 |
{ |
191 |
{ |
| Line 185... |
Line 199... |
| 185 |
} |
199 |
} |
| 186 |
|
200 |
|
| 187 |
void reflow_solder() |
201 |
void reflow_solder() |
| 188 |
{ |
202 |
{ |
| 189 |
|
203 |
|
| - |
|
204 |
struct time process_time; |
| - |
|
205 |
|
| 190 |
// preheat |
206 |
// preheat |
| 191 |
nullcas(&cas); |
207 |
nullcas(&cas); |
| - |
|
208 |
lcd_gotoxy(1,2); |
| - |
|
209 |
printf(lcd_putc,"PREHEAT"); |
| 192 |
|
210 |
|
| 193 |
do { |
211 |
do { |
| 194 |
slope_control(PREHEAT_SLOPE, 0); // hlida strmost predehrevu |
212 |
slope_control(PREHEAT_SLOPE, 0); // hlida strmost predehrevu |
| 195 |
|
213 |
|
| 196 |
lcd_gotoxy(1,1); |
214 |
lcd_gotoxy(1,1); |
| Line 198... |
Line 216... |
| 198 |
|
216 |
|
| 199 |
lcd_gotoxy(9,1); |
217 |
lcd_gotoxy(9,1); |
| 200 |
printf(lcd_putc,"%2u:%02u:%02u",cas.hod,cas.min,cas.sec); |
218 |
printf(lcd_putc,"%2u:%02u:%02u",cas.hod,cas.min,cas.sec); |
| 201 |
|
219 |
|
| 202 |
delay_ms(1000); |
220 |
delay_ms(1000); |
| - |
|
221 |
if (cas.min>3) heat_failure(); |
| 203 |
} |
222 |
} |
| 204 |
while (teplota() < SOAK_TEMP); |
223 |
while (teplota() < SOAK_TEMP); |
| 205 |
|
224 |
|
| 206 |
// soak |
225 |
// soak |
| 207 |
nullcas(&cas); |
226 |
nullcas(&cas); |
| 208 |
while (cas.min*60+cas.sec <= SOAK_TIME) |
227 |
process_time.min = SOAK_TIME/60; |
| - |
|
228 |
process_time.sec = SOAK_TIME - process_time.min*60; |
| - |
|
229 |
|
| - |
|
230 |
lcd_gotoxy(1,2); |
| - |
|
231 |
printf(lcd_putc,"SOAK "); |
| - |
|
232 |
|
| - |
|
233 |
while (process_time.sec!=0 || process_time.min!=0) |
| 209 |
{ |
234 |
{ |
| 210 |
level_control(SOAK_TEMP); |
235 |
level_control(SOAK_TEMP); |
| 211 |
|
236 |
|
| 212 |
lcd_gotoxy(1,1); |
237 |
lcd_gotoxy(1,1); |
| 213 |
printf(lcd_putc,"%3.1f\21C ",teplota()); |
238 |
printf(lcd_putc,"%3.1f\21C ",teplota()); |
| 214 |
|
239 |
|
| - |
|
240 |
if ((process_time.sec = process_time.sec - cas.sec)<0) process_time.sec=59; |
| - |
|
241 |
|
| - |
|
242 |
process_time.min = (SOAK_TIME - cas.min*60 - cas.sec)/60; |
| - |
|
243 |
process_time.sec = (SOAK_TIME - cas.min*60 - cas.sec) - process_time.min*60; |
| - |
|
244 |
|
| 215 |
lcd_gotoxy(9,1); |
245 |
lcd_gotoxy(9,1); |
| 216 |
printf(lcd_putc,"%2u:%02u:%02u",cas.hod, SOAK_TIME/60 - cas.min, SOAK_TIME - cas.min*60 - cas.sec); |
246 |
printf(lcd_putc,"%2u:%02u:%02u",cas.hod, process_time.min, process_time.sec); |
| 217 |
delay_ms(1000); |
247 |
delay_ms(1000); |
| 218 |
} |
248 |
} |
| 219 |
|
249 |
|
| 220 |
// solder |
250 |
// solder |
| 221 |
|
251 |
|
| Line 232... |
Line 262... |
| 232 |
|
262 |
|
| 233 |
nullcas(&cas); |
263 |
nullcas(&cas); |
| 234 |
|
264 |
|
| 235 |
while(true) |
265 |
while(true) |
| 236 |
{ |
266 |
{ |
| 237 |
delay_ms(300); |
267 |
delay_ms(300); |
| 238 |
|
- |
|
| 239 |
|
- |
|
| 240 |
reflow_solder(); |
268 |
reflow_solder(); |
| 241 |
|
269 |
|
| 242 |
} |
270 |
} |
| 243 |
} |
271 |
} |