Newer
Older
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
#include "orders.h"
orders_t orders;
void do_orders()
{
if(orders.open_ev_step)
{
vanne_step_open(orders.open_ev_step_value);
orders.open_ev_step = 0;
}
if(orders.close_ev_step)
{
vanne_step_close(orders.close_ev_step_value);
orders.close_ev_step = 0;
}
if(orders.open_ev)
{
vanne_open();
orders.open_ev=0;
}
if(orders.close_ev)
{
vanne_close();
orders.close_ev=0;
}
if(orders.vidange_ev)
{
vanne_vidange();
orders.vidange_ev=0;
}
if(orders.get_T)
{
orders.get_T=0;
int16_t temp;
uint8_t status_thermo;
uint8_t tries=0;
while(1)
{
status_thermo = thermometer_gettemp(&temp,1000);
debug_printf("get temp, status = %u\n", status_thermo);
if(status_thermo==0)
break;
tries++;
if(tries>=4)
break;
}
if(status_thermo > 0)
{
status.failT = 1;
}
else
{
status.failT = 0;
status.temperature_insta = temp;
if(median_filter_thermometer_filled)
median_filter_thermometer_update(temp);
else
{
median_filter_thermometer_fill(temp);
status.temperature.v1 = status.temperature.v2 = .0625*temp;
}
float Tinstamf = .0625*median_filter_thermometer_read();
update_filtre2(&(status.temperature), THERMO_FACTOR_FILTRE, Tinstamf);
if(cconfig.mode == MODE_AUTO)
{
float temperature_diff = status.temperature.v2 - cconfig.consigne_temperature;
status.accu_integrateur += temperature_diff * 5 / cconfig.ti;
float max_integrateur = cconfig.debit_max/cconfig.Kp - temperature_diff;
if(max_integrateur<0)
max_integrateur = 0;
if(status.accu_integrateur>max_integrateur)
status.accu_integrateur = max_integrateur;
if(status.accu_integrateur<0)
status.accu_integrateur = 0;
status.consigne_debit = cconfig.Kp * (temperature_diff + status.accu_integrateur);
}
}
}
}