fix formula
This commit is contained in:
parent
92c1aaefbe
commit
f3e2e0181a
|
|
@ -598,6 +598,8 @@ long my_read_average(byte gain, byte times) {
|
||||||
void ReadSensors(SENSOR_data &sensor_data) {
|
void ReadSensors(SENSOR_data &sensor_data) {
|
||||||
SENSOR_data res;
|
SENSOR_data res;
|
||||||
int32_t weight_current32;
|
int32_t weight_current32;
|
||||||
|
long w1_0_real;
|
||||||
|
long w2_0_real;
|
||||||
|
|
||||||
// vBat
|
// vBat
|
||||||
gCatena.poll();
|
gCatena.poll();
|
||||||
|
|
@ -608,6 +610,8 @@ void ReadSensors(SENSOR_data &sensor_data) {
|
||||||
}
|
}
|
||||||
|
|
||||||
// Read Scales
|
// Read Scales
|
||||||
|
w1_0_real = config_data.cal_w1_0;
|
||||||
|
w2_0_real = config_data.cal_w2_0;
|
||||||
if (setup_scales()) {
|
if (setup_scales()) {
|
||||||
if (config_data.debug_level > 0) {
|
if (config_data.debug_level > 0) {
|
||||||
gCatena.SafePrintf("%010d - HX711 LoadCell is ready.\n", millis());
|
gCatena.SafePrintf("%010d - HX711 LoadCell is ready.\n", millis());
|
||||||
|
|
@ -620,6 +624,7 @@ void ReadSensors(SENSOR_data &sensor_data) {
|
||||||
}
|
}
|
||||||
} else {
|
} else {
|
||||||
res.weight1 = 0;
|
res.weight1 = 0;
|
||||||
|
w1_0_real = 0;
|
||||||
if (config_data.debug_level > 0) {
|
if (config_data.debug_level > 0) {
|
||||||
gCatena.SafePrintf("%010d - Load_cell 1 is disabled\n", millis());
|
gCatena.SafePrintf("%010d - Load_cell 1 is disabled\n", millis());
|
||||||
}
|
}
|
||||||
|
|
@ -632,6 +637,7 @@ void ReadSensors(SENSOR_data &sensor_data) {
|
||||||
}
|
}
|
||||||
} else {
|
} else {
|
||||||
res.weight2 = 0;
|
res.weight2 = 0;
|
||||||
|
w2_0_real = 0;
|
||||||
if (config_data.debug_level > 0) {
|
if (config_data.debug_level > 0) {
|
||||||
gCatena.SafePrintf("%010d - Load_cell 2 is disabled\n", millis());
|
gCatena.SafePrintf("%010d - Load_cell 2 is disabled\n", millis());
|
||||||
}
|
}
|
||||||
|
|
@ -648,7 +654,8 @@ void ReadSensors(SENSOR_data &sensor_data) {
|
||||||
digitalWrite(D10, LOW);
|
digitalWrite(D10, LOW);
|
||||||
|
|
||||||
// Gewicht berechnen
|
// Gewicht berechnen
|
||||||
weight_current32 = (int32_t)((((res.weight1 - config_data.cal_w1_0) / config_data.cal_w1_factor) + ((res.weight2 - config_data.cal_w2_0) / config_data.cal_w2_factor)) / 5.0);
|
weight_current32 = (int32_t)((((res.weight1 - w1_0_real) / config_data.cal_w1_factor) + ((res.weight2 - w2_0_real) / config_data.cal_w2_factor)) / 5.0);
|
||||||
|
|
||||||
if (weight_current32 < 0) {
|
if (weight_current32 < 0) {
|
||||||
weight_current32 = 0;
|
weight_current32 = 0;
|
||||||
} else if (weight_current32 > UINT16_MAX) {
|
} else if (weight_current32 > UINT16_MAX) {
|
||||||
|
|
|
||||||
Loading…
Reference in New Issue